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The  two  parallel  approaches  of  screw  theory  and  Lie  groups,  used  in  the  analysis 
of  robot  manipulators,  are  contrasted.  The  fundamental  aspects  of  screw  theory  are 
shown  to  arise  as  a natural  consequence  of  the  group  structure  and  the  differential  ge- 
ometric properties  of  the  Euclidean  group.  The  Lie  algebra  is  shown  to  be  equivalent 
to  the  space  of  twists  encountered  in  screw  theory. 

As  an  application  of  the  theoretical  framework  provided  by  the  semi-Riemannian 
structure  of  the  Euclidean  group,  an  invariant  measure  is  defined  and  used  to  quantify 
the  concept  of  motion  capability  of  a robot  manipulator.  The  measure  is  shown  to 
arise  from  a symmetric  bilinear  form  also  known  as  the  reciprocal  product.  This 
measure  is  shown  to  be  applicable  to  manipulators  of  arbitrary  design.  In  particular, 
it  is  shown  to  be  independent  of  the  parameterization  of  the  manipulator  and  the 
type  and  number  of  joints  in  the  manipulator.  The  singularities  of  the  manipulator 
are  also  shown  to  be  predicted  by  the  measure.  Finally,  it  is  shown  that,  when  applied 
to  redundant  manipulators,  the  measure  quantifies  the  importance  of  each  joint  of 
the  manipulator. 
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CHAPTER  1 
INTRODUCTION 

1.1  Overview 

The  pages  that  follow  are  an  attempt  to  unify  two  parallel  approaches  that 
currently  exist  in  the  study  of  spatial  kinematics  and  its  application  to  robot  manip- 
ulators. A robot  manipulator  can  be  considered  to  be  an  open  chain  of  rigid  bodies 
connected  together  by  joints  which  define  the  relative  freedom  of  motion  of  adjacent 
bodies  in  the  chain. 

One  approach  to  spatial  kinematics  uses  screw  theory  which  models  the  instanta- 
neous motion  of  a body  in  space  as  an  infinitesimal  rotation  about  some  axis  together 
with  an  infinitesimal  translation  along  that  axis.  This  is  interpreted  as  an  instanta- 
neous screw-like  motion,  called  a twist,  which  is  the  fundamental  geometric  concept 
on  which  the  theory  is  based.  The  other  approach  involves  the  use  of  Lie  groups,  and 
models  the  motion  of  a body  in  space  as  a curve  in  a six  dimensional  space  consisting 
of  all  possible  rotations  and  translations  of  an  object. 

The  engineer  has  traditionally  used  screw  theory  in  the  analysis  of  the  subject. 
This  approach  was  first  comprehensively  addressed  by  Ball  [1].  This  inspiring  work  is 
notable  for  its  geometric  insight  and  intuitive  reasoning  in  the  absence  of  a systematic 
representation  which  exists  today  via  the  use  of  line  geometry,  Plucker  co-ordinates, 
and  dual  quaternions. 

In  contrast,  the  mathematician  working  in  the  field  of  spatial  kinematics  has 
preferred  the  use  of  Lie  groups,  which  is  a combination  of  group  theory  and  differential 
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geometry.  This  approach  is  partly  due  to  training,  but  also  due  to  the  large  body  of 
supporting  theory  in  these  areas  which  can  be  used  to  one’s  advantage.  Indeed,  the 
origins  of  differential  geometry  can  be  traced  back  well  over  a century  to  the  works  of 
Riemann.  His  preliminary  papers,  which  are  found  translated  by  Clifford  [5],  laid  the 
foundations  for  differential  geometry  and  exhibit  an  appreciation  of  the  concepts  of  a 
manifold  and  metric  decades  before  these  ideas  were  fully  articulated  and  formalized. 

Today,  the  parallel  approaches  to  spatial  kinematics  are  typified  by  two  compre- 
hensive works.  The  first  is  by  Hunt  [8]  and  contains  an  exhaustive  study  on  systems 
of  screws  and  the  concept  of  reciprocity  which  describes  the  relationship  between 
the  constraints  on,  and  freedoms  of,  a body.  The  second  is  by  Karger  [11].  This 
work  views  the  Euclidean  group,  which  can  be  considered  to  be  the  set  of  all  possible 
rotations  and  translations  of  an  object,  as  a six  dimensional  differentiable  manifold 
endowed  with  a semi-Riemannian  metric.  This  approach  yields  precisely  the  same 
results,  concerning  screw  systems  and  reciprocity,  and  differs  only  in  its  formulation 
in  terms  of  group  theoretic  and  differential  geometric  structures  such  as  group  orbits 
and  bilinear  forms.  Indeed,  both  approaches  can  be  seen  to  be  utilised  by  Bottema 
and  Roth  [3]. 

One  advantage  of  screw  theory  is  its  ability  in  explaining  a wide  variety  of  con- 
cepts in  spatial  kinematics  without  the  use  of  groups  and  differentiable  manifolds. 
Screw  theory  has  probably  gained  prominence  due  to  the  engineer’s  tendency  to 
choose  a physically  natural  description  of  phenomena  rather  than  look  for  hidden 
mathematical  structures.  Indeed,  at  first  glance  one  finds  little  need  of  manifolds 
and  semi-Riemannian  metrics,  preferring  the  appealing  concept  of  an  instantaneous 
screw-like  motion  instead.  Unfortunately,  this  approach  inherently  precludes  infor- 
mation about  the  finite  motions  from  which  the  instantaneous  motions  are  derived. 
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This  results  in  obscuring  the  structure  of  the  Euclidean  group,  and  omits  the  rich 
mathematical  framework  contained  therein. 

Very  recently,  a few  works  have  begun  to  address  this  problem  with  applications 
of  spatial  kinematics  to  robot  manipulators.  The  work  by  Rico  [15]  studies  explicit 
representations  of  the  Euclidean  group  and  their  application  to  manipulators.  Also, 
Brockett  [4]  and  Loncaric  [12]  apply  the  group  structure  to  the  problem  of  the  control 
of  manipulators.  Finally  Karger  [9]  [10],  in  two  key  papers,  makes  a direct  application 
of  some  well  known  results  in  the  areas  of  Lie  groups  and  Riemannian  geometry  to 
manipulators.  Unfortunately,  these  last  two  papers  seem  to  have  been  overlooked  in 
the  field  due  to  their  highly  mathematical  nature. 

Karger’s  papers  illustrate,  in  an  unambiguous  way,  the  primary  advantage  in 
using  Lie  groups  in  the  study  of  robot  manipulators.  They  contain  results  which  are 
dependent  on  the  application  of  well  known  theorems  in  group  theory  and  differential 
geometry.  Furthermore,  this  approach  is  inherently  co-ordinate  free  and  leads  to 
compact  expressions  involving  elements  of  the  group  and  their  derivatives. 

The  primary  aim  of  this  work  is  to  unify  the  two  approaches  to  spatial  kinematics 
in  their  application  to  robot  manipulators.  By  reading  this  work,  it  is  hoped  that  the 
mathematician  acquires  a good  grasp  of  the  kinematic  aspects  of  robot  manipulators 
and  an  appreciation  of  the  very  practical  application  of  some  well  established  mathe- 
matical theory.  Analogously,  it  is  hoped  that  this  work  conveys,  to  the  engineer,  the 
richness  and  power  of  using  the  Lie  group  approach. 

This  endeavour  is  attempted  by  examining  the  fundamental  aspects  of  screw 
theoiy  and  showing  that  they  arise  as  a natural  consequence  of  the  group  structure 
and  differential  geometric  properties  of  the  Euclidean  group.  This  is  shown  in  an 
systematic  and  comprehensive  way  that  reveals  the  link  between  the  instantaneous 
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motion  of  a body,  represented  by  a twist,  and  a curve  in  the  Euclidean  group  rep- 
resenting the  finite  motion  from  which  the  twist  is  derived.  This  link  is  then  used 
in  developing  an  application  to  robot  manipulators  that  is  global  in  its  scope.  By 
global,  it  is  meant  that  a complete  methodology  is  developed  that  is  applicable  to 
robot  manipulators  of  arbitrary  design.  Such  global  results  are  rare  in  robotics.  In 
this  particular  case,  it  is  a direct  consequence  of  utilising  the  fundamental  structure 
of  the  Euclidean  group  that  is  only  revealed  by  the  Lie  group  approach. 

1.2  The  Fundamental  Concept  of  Motion  Capability 

The  global  application  that  is  be  developed  here  is  a method  to  quantitatively 
compare  the  varying  designs  of  robot  manipulators.  It  is  recalled  that  a robot  ma- 
nipulator is  an  open  chain  of  rigid  bodies  connected  together  by  joints  which  define 
the  relative  freedoms  of  motion  of  adjacent  bodies  in  the  chain.  It  is  usually  the 
bodies  at  each  end  of  the  chain  that  are  the  focus  of  analysis  in  robotics.  One  body 
is  called  the  end  effector,  while  the  other  is  called  the  base  of  the  manipulator  and 
is  considered  unmovable  and  attached  to  the  ground.  The  motion  of  the  end  effector 
is  then  related  to  the  motion  of  the  system  of  bodies  and  and  joints  attaching  it  to 
the  base.  Thus,  it  is  clear  that  the  end  effector  can  only  achieve  some  subset  of  all 
the  possible  rotations  and  translations  of  an  unconstrained  body  unconnected  to  the 
base.  Quantifying  this  subset  yields  a number  related  to  what  is  defined  to  be  the 
motion  capability  of  the  manipulator.  The  solution  to  accomplishing  this  in  a com- 
pletely invariant  way  lies  in  using  the  existence  of  the  concept  of  a generalised  volume 
element  on  the  Euclidean  group.  This  volume  element  arises  from  the  fact  that  the 
Euclidean  group  is  a differentiable  manifold  endowed  with  a semi-Riemannian  struc- 
ture. The  investigation  of  volume  elements  on  this  class  of  manifolds  are  based  on 
well  known  theoretical  results  and  are  found  generalised  by  Boothby  [2]  and  O’Neill 
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[14],  for  example.  There  are  also  some  purely  mathematical  applications  of  the  vol- 
ume element  of  the  Euclidean  group,  in  particular,  which  are  considered  by  Gel’fand 
et  al.  [7]  and  Vilenkin  [16]. 

The  specific  application  of  the  volume  element  of  the  Euclidean  group  to  robot 
manipulators  is,  however,  very  recent.  It  was  first  suggested  as  a possible  area  of 
study  by  Loncaric  [12].  The  foundations  for  its  applications,  however,  were  laid  by 
Karger  [10]. 

One  consequence  of  the  existence  of  the  volume  element  is  that  it  not  only 
gives  one  a measure  of  the  motion  capability  of  the  end  effector  of  the  manipulator, 
but  also  predicts  the  singularities  of  the  manipulator.  The  singularities  are  those 
configurations  of  the  manipulator  in  which  the  end  effector  loses  one  or  more  degrees 
of  freedom,  and  are  the  subject  of  much  analysis  in  robotics.  Another  application, 
not  addressed  in  this  work,  is  that  of  applying  the  comparative  technique  developed 
to  optimize  the  design  of  a manipulator.  This  is  another  area  of  intensive  study  in 
robotics.  Thus,  the  volume  element  appears  to  have  profound  consequences  in  the 
analysis  of  robot  manipulators. 

1.3  Summary  of  Chapters 

Chapter  Two  contains  the  definitions  necessary  for  a mathematical  description  of 
the  Euclidean  group.  It  introduces  the  concepts  of  a topological  space , a differentiable 
manifold  and  a Lie  group  with  the  help  of  some  familiar  examples.  This  chapter  may 
be  omitted  by  the  mathematician,  but  the  engineer  who  may  be  unfamiliar  with  some 
of  these  topics  may  wish  to  address  it.  The  approach  is  brief,  and  the  reader  may  wish 
to  refer  to  a number  of  modern  works  for  additional  details.  For  a comprehensive 
introduction  to  topology,  refer  to  Munkres  [13].  do  Carmo  [6]  has  a good  introduction 
to  the  differential  geometry  of  curves  and  surfaces,  while  Boothby  [2]  has  a more 
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generalised  treatment  of  differentiable  manifolds.  O’Neill  [14]  has  an  introduction 
to  semi-Riemannian  manifolds  and  Warner  [17]  has  additional  information  on  Lie 
groups. 

Chapter  Three  introduces  the  Euclidean  group  and  its  application  to  analysing 
the  motion  of  a rigid  body  in  space  and  time.  Frames  of  reference  are  defined  and  the 
interpretation  of  the  Euclidean  group  as  mappings  between  these  frames  is  studied. 
The  group  and  differentiable  structures  of  these  mappings  are  revealed  and  a suitable 
representation  is  chosen  for  them. 

Chapter  Four  studies  the  concept  of  the  tangent  bundle  of  a differentiable  man- 
ifold by  first  examining  its  implications  in  Euclidean  n-space  and  real  n-space.  The 
idea  is  then  generalised  to  the  concept  of  derivations  on  a differentiable  manifold. 
The  geometric  interpretation  of  a tangential  mapping  is  explored. 

Chapter  Five  applies  the  concept  of  a tangent  bundle  to  the  Euclidean  group.  In 
particular,  the  structure  of  the  Lie  algebra,  which  is  the  tangent  space  at  the  identity 
element  of  the  Euclidean  group,  is  examined.  Its  direct  relationship  to  the  space  of 
twists,  encountered  in  screw  theory,  is  revealed.  Finally,  the  physical  interpretation 
of  the  left  and  right  tangential  mapping  is  studied. 

Chapter  Six  investigates  the  composition  of  elements  of  the  Euclidean  group. 
Special  cases  are  interpreted  as  a change  in  a frame  of  reference.  The  adjoint  mapping 
and  its  relationship  to  such  changes  is  revealed,  and  the  link  to  a well  known  screw 
transformation  matrix  is  made. 

Chapter  Seven  introduces  the  concept  of  a volume  element  by  first  examining  the 
implications  in  R2  and  on  the  surface  of  a sphere.  The  idea  is  then  applied  to  planar 
robot  manipulators  with  an  accompanying  geometric  interpretation.  This  is  then  gen- 
eralised to  spatial  motion  by  computing  the  volume  element  of  the  Euclidean  group. 
The  element  is  applied  to  an  existing  industrial  robot  and  then  further  generalised 
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to  accommodate  redundant  manipulators.  This  form  is  then  used  in  determining 
the  efficacy  of  two  design  variations  of  the  Flight  Telerobotic  Servicer  Manipulator 
System,  a space  based  seven  revolute  manipulator  currently  being  considered  by  the 
National  Aeronautics  and  Space  Administration. 


CHAPTER  2 
PRELIMINARIES 


Definition:  A topological  space  is  a pair  ( X , fi),  where  AT  is  a set  and  H is  a collection 
of  subsets  of  X , called  open  sets,  such  that 

1.  The  empty  set  <f>  and  the  whole  set  X are  open. 

2.  If  U and  V are  open,  so  is  U ft  V. 

3.  If  {Ua\a  G A}  is  a (possibly  infinite)  family  of  open  sets,  then  Uae-4  Ua  is  open. 

The  collection  Q is  called  a topology  on  X.  It  is  common  to  omit  specific  mention  of 
the  collection  f I if  no  confusion  will  arise  by  referring  to  the  topological  space  X. 
Example:  Let  X be  the  three  element  set  X = {a,  b,  c}.  Three  possible  topologies 
on  X are  shown  in  Figure  2.1.  The  topology  on  the  left  is  the  simplest  in  which 
the  only  sets  are  X and  <f>.  The  topology  in  the  middle  contains  X,  (j),  [a,  6],  [6],  [6,  c]. 
The  topology  on  the  right  contains  every  subset  of  X.  It  is  clear  that  even  a three 
element  set  has  several  topologies.  In  this  example  it  is  possible  to  describe  the  entire 
collection  f I of  open  sets.  In  most  cases  this  is  difficult  and  one  usually  specifies  a 
smaller  collection  of  subsets  of  X from  which  the  topology  is  generated.  This  process 
requires  two  additional  definitions. 

Definition:  A basis  for  a topology  on  X is  a collection  B of  subsets  of  X (called 
basis  elements ) such  that 

1.  For  each  x € X,  there  is  at  least  one  basis  element  B containing  x. 
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Figure  2.1.  Topologies  on  a Three  Element  Set 

2.  If  x belongs  to  the  intersection  of  two  basis  elements  B\  and  B2,  then  there  is 
a basis  element  B3  containing  x such  that  B3  C Bx  H B2. 

Definition:  If  B is  a basis  for  a topology  on  X,  the  collection  H generated  by  B is 
described  as  follows:  A subset  U of  X is  defined  to  be  open  in  X (that  is,  to  be  an 
element  of  fl)  if  for  each  x £ U,  there  is  a basis  element  B 6 B such  that  x £ B and 
B C U . It  can  be  checked  that  the  collection  f 1 defines  a topology  on  X. 

Example:  Let  B be  the  collection  of  intervals  in  the  real  line  R of  the  form 
(a,b)  = { x\a  < x <b}.  It  can  be  checked  that  this  forms  a basis  for  a topology 
on  R.  The  topology  generated  by  B can  be  described  as  follows:  A subset  U of  R 
is  defined  to  be  open  in  R if  and  only  if  for  each  x 6 U,  there  is  a set  B e B such 
that  x £ B and  B C U.  This  topology  is  called  the  standard  topology  on  R.  One 
can  extend  this  to  a topology  on  Rn  by  defining  B to  be  the  collection  of  sets  of  the 
form  (aiA)  x ( a2,b2 ) x ...  x (an,6n)  = {(*1,*2,...,xn)|*i  <E  (at-,6,),i  = l,...,n}. 
This  set  can  be  pictured  as  the  interior  of  an  n-cube  in  Rn. 

Definition:  A topological  space  X is  called  Hausdorff  if  and  only  if  for  all  x,y  £ X 
with  x ^ y,  there  are  open  sets  U and  V containing  x and  y respectively  such  that 
U 0 V = <f>. 

Example:  R is  Hausdorff.  If  x,y  € R with  x ± y,  then  U = (x  - ^,x+  ^1) 

and  V = (y  — Mpl ,y  + are  non-intersecting  open  sets  containing  x and  y 

respectively. 
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Definition:  Let  X and  Y be  topological  spaces.  A function  / : X — ► Y is  said  to 
be  continuous  if  and  only  if  for  each  open  subset  V of  Y,  the  pre-image  /-1(E)  is  an 
open  subset  of  X. 

Example:  It  can  be  shown  that  the  above  definition  is  equivalent  to  the  (e,  6)  def- 
inition of  continuity  of  real  valued  functions  / : R — > R,  when  R is  endowed  with 
the  standard  topology.  See  Munkres  [13]  for  a detailed  proof. 

Definition:  Let  X and  Y be  topological  spaces.  Let  / : X — ► Y be  a bijection. 
The  function  / is  called  a homeomorphism  if  and  only  if  both  / and  its  inverse 
/_1  : Y — > X are  continuous. 

Definition:  An  n-dimensional  topological  manifold  is  a Hausdorff  topological  space 
such  that  each  point  has  an  open  set  containing  it  which  is  homeomorphic  to  an  open 
set  of  R". 

Definition:  A co-ordinate  chart  on  a topological  manifold  M is  a pair  (U,x)  where 
U is  an  open  subset  of  M,  and  x : U — » R"  is  a homeomorphism  of  U to  an  open 
subset  x{U)  of  Rn.  If  one  writes  x(p)  - (xx(p), . . . , xn{p))  for  each  p 6 M,  the 
resulting  real  valued  functions  xx,...,xn  on  U are  called  the  co-ordinate  functions 
of  x. 

Definition:  Let  U be  an  open  subset  of  Rn  and  let  f : U — * R".  The  function  / 
is  said  to  be  differentiable  if  and  only  if  all  partial  derivatives  of  all  orders  of  / exist 
and  are  continuous. 

Definition:  Two  n-dimensional  co-ordinate  charts  (U,x)  and  (V,y)  are  called 
compatible  if  and  only  if  the  functions  x o y-1  and  y o x~l  are  differentiable.  More 
explicitly, 

x o y~l : y(u  n v)  — ♦ x(u  n v) 


and 
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Figure  2.2.  Compatible  Co-ordinate  Systems 


y ox1:  x(U  ft  V)  — > y(U  D V) 

are  both  functions  from  Rn  to  Rn.  The  co-ordinate  functions  are  denoted  by 

0 y1,  i = l,...,n 


and 


Vi  ox  \ i = l,...,n. 


If  these  co-ordinate  functions  are  differentiable,  then  one  says  the  two  co-ordinate 
charts  are  compatible.  See  Figure  2.2  for  a depiction  of  the  mappings. 

Definition:  A differentiable  structure  on  a topological  manifold  M is  a family 
U — {UQ,xa}  of  co-ordinate  charts  on  M such  that 


1.  The  Ua  cover  M. 


2.  Ua  and  Up  are  compatible  for  any  a and  0 in  the  collection 
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Figure  2.3.  Covering  of  the  Sphere 


3.  Any  co-ordinate  chart  (V,y),  which  is  compatible  with  every  (UQ,xa),  is  itself 
in  U. 

Definition:  An  n-dimensional  differentiable  manifold  is  a topological  manifold  of 
dimension  n,  together  with  a differentiable  structure. 

Example:  Consider  the  unit  sphere  S2  = {(a:,  y,  z)\  x2+y2+z2  = 1}.  It  is  shown  that 
S2  satisfies  the  definition  of  a two-dimensional  differentiable  manifold:  A topology 
can  be  induced  on  S 2 by  defining  U to  be  open  in  S2  if  and  only  if  there  exists  an 
open  subset  V of  R3  such  that  U = V D S2.  This  is  called  the  subspace  topology 
on  S2  induced  by  the  standard  topology  on  R3.  It  can  be  checked  that  S2,  with 
the  subspace  topology,  satisfies  the  definition  of  a topological  space.  It  can  also 
be  checked  that  this  implies  S 2 is  Hausdorff,  as  this  property  is  inherited  from  the 
ambient  space  R3.  Now  let  Vff  = {{x,y,z)\x  > 0}  and  V~  = {(x,y,z)\x  < 0}. 
Also  let  V+  = {(x,y,z)\y  > 0}  and  Vy~  = {(x,  y,  z)\y  < 0}.  Similarly  define  Vff. 
These  six  sets  are  open  in  R3.  Hence,  via  the  subspace  topology,  £/+  = Vff  fl  S 2 and 
Uf  = V~  C S2  are  open  in  S 2,  as  are  U*  and  Uf.  These  sets,  which  are  depicted  in 


Figure  2.3,  also  cover  S 2 . Define 
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= (*x,  0,  ) 


Figure  2.4.  Co-ordinate  Chart  on  the  Sphere 


< ■ U*  — R2 

such  that 

(x,y,z)  i — > (<^r,0x), 


where 


-l 


4>x  = cos'  * 2 

6X  = sin-1  y. 


See  Figure  2.4  for  a depiction  of  this  mapping.  Define 


tt;  : U~  R2 


such  that 


(x,y,z)  i — > {<f>x,0x), 


where 


(f)x  = cos  1 z 
6X  = 7r  — sin-1  y. 


Similarly  define 


7 *t(x,y,z)  = (</>y,ey), 


where 


(j)y  = cos  1 x 
0y  = sin-1 2, 


and 


77 y {X,>y<>z)  ((f>yi^y)i 

where 


<j)y  = cos  1 x 
0y  = ir  — sin-1  z. 


Finally  define 


T+(x,y,z)  = ((j>z,e2), 


where 
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<t>z  = cos  xy 
0 z = sin-1  x, 

and 

n;(x,y,z)  = ( (f>z,9z ), 

where 


<I>Z  = COS  1 y 

6Z  = 7r  — sin-1  x. 

It  is  noted  that  the  mappings  7T+,  7 r+,  7T+  are  homeomorphisms  of  the  sets  U£,  Uy,  U+ 
to  (0,7r)  x (— f,f).  Similarly,  the  mappings  7r^",7r~,7rJ  are  homeomorphisms  of  the 
sets  U~,U~ , U~  to  (0,7 r)  x (|,  ^).  Thus,  S 2 is  a two-dimensional  topological  mani- 
fold. Now  consider  the  co-ordinate  transformation 

< ° [<]■' : n Vi)  — » ir^(ty  n (yv+). 

Here, 

{<t>x,@x)  ► (sin  <j>x  cos  0^,  sin  sin  0*,  cos  </>x) 

i-^->  (cos-1  (sin  cos  0X),  sin-1  (cos  ^x)). 


Alternatively, 


^ 0 [<]  1 = <(££  H 27+)  — ► 7 r+(C/+  n [/+). 


Here, 
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(fiyi  @y) 


(sin  (f>y  cos  9y,  sin  <f>y  sin  0y,  cos  4>y) 
(<j>y,  sin-1  (sin  <f>y  sin  6y). 


Clearly,  the  functions 

*‘y°[’r2']"1  and 


are  differentiable  since  <f>x,  4>y  ^ 0, 7r  and  6x,6y  ^ ±f.  By  similar  computations  it 
can  be  shown  that  all  six  mappings  are  compatible  with  each  other.  There  is,  thus, 
a natural  covering  of  S2  by  six  co-ordinate  charts  which  determine  a unique  differen- 
tiable structure.  This  family  of  co-ordinate  charts  can  be  completed  by  defining  any 
other  mapping  to  be  in  the  family  if  and  only  if  it  is  compatible  with  the  above  six. 
Thus,  S2  is  a two-dimensional  differentiable  manifold. 

Example:  Consider  the  set  MnXn  of  n x n real  matrices.  It  is  shown  that  this  set  is 
2 

an  Rn  - dimensional  differentiable  manifold:  There  exists  the  natural  mapping 


X : MnXn 


R” 


such  that 


9 ii 

9n  1 


9 In 


[9 


11, 


, <7ln,  <721, 


> 9nn\ 


This  is  clearly  a bijection.  One  can  define  a topology  on  MnXn  in  the  following 
manner:  Let  U be  an  open  subset  of  Mnxn  if  and  only  if  X(U ) is  open  in  Rn2.  With 
this  topology,  Mnxn  is  homeomorphic  to  R”2  and  inherits  the  differentiable  structure 
on  R”2.  Hence,  MnXn  is  an  n2-dimensional  differentiable  manifold. 

Definition:  A group  is  set  G with  a binary  operation  0 such  that 
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1.  If  g,  h are  elements  of  G,  then  so  is  g o h.  This  is  called  the  closure  property. 

2.  If  g,  /i,  k are  elements  of  G,  then  g o (h  o k)  = (g  o h)  o k.  This  is  called  the 
associative  property. 

3.  There  exists  an  identity  element  e € G,  such  that  eog  = got  = g for  all  g 6 G. 

4.  For  each  g G G,  there  exists  an  inverse  element  g~x  € G,  such  that 

g °#_1  = g~l  °#  = e. 

Example:  Consider  the  subset  G of  M of  the  form 

<7n  #12  #13  g x 

#21  #22  #23  9y 

#31  #32  #33  #2 

.0  0 0 1 

with  the  requirement  that 

f 1 if  i — j 

^ 9ik9jk  ~ { 0 if  (2J) 

for  i,j  = 1, . . . , 3.  It  is  shown  that  this  set  is  a group  under  the  binary  operation  of 
matrix  multiplication:  Let  g € G,  and  let  [g]3x3  denote  the  upper  left  3x3  minor  of 
g.  It  can  be  checked  that  the  requirement  given  in  (2.1)  is  equivalent  to  the  condition 

[g]3x3[g]3x3  = 13X3- 

Here,  the  superscript  t denotes  the  transpose  of  the  appropriate  matrix,  and  l3x3 
denotes  the  identity  3x3  matrix.  Let  g,  h <E  G.  Then  matrix  multiplication  shows 
that  gh  has  the  form 

in  ii2  i 13  jx 
j _ 721  722  723  jy 

731  732  733  jx 

.0  0 0 1. 
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where,  in  particular, 


[j]  3 X 3 — [g]3x3[h]3x3- 


Thus 


[j  ] 3 X 3 [j  ] 


t 

3X3 


[g]3x3[h]3x3[h]‘x3[g]‘x3 

[g]3x3[g]3x3 

13x3- 


Hence,  j is  an  element  of  G and  the  closure  property  is  satisfied. 


The  associative 


property  is  satisfied  by  checking  that  matrix  multiplication  is  associative.  Existence 


of  the  identity  element  is  satisfied  by  noting  that  the  4x4  identity  matrix  l4x4  is  the 
identity  element  of  the  group.  The  existence  of  an  inverse  element  for  each  element 


of  G is  satisfied  by  checking  that 


<7n  <721 
<7l2  <722 

<?13  <723 

0 0 


<731  — (#11  <7*  -f  9\29y  + 9\z9z) 

932  — (<721<7x  + 9229y  + <723<7z) 

<733  — (<731<7x  + <732  <7s,  + <733  <7z) 

0 1 


satisfies  the  condition  of  an  inverse  element.  Thus,  G is  a group. 

Definition:  A Lie  group  is  a differentiable  manifold  which  also  possesses  a group 
structure  such  that  the  mapping 


G x G 


G 


defined  by 


(g,h)  i — > gh  1 


(2.2) 


is  differentiable. 
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Example:  The  set  G of  all  4 x 4 matrices  given  in  the  previous  example  is  a Lie 
group.  This  is  demonstrated  by  the  following  argument:  It  has  been  shown  in  the 
previous  example  that  G is  a group.  It  has  also  been  shown  in  a previous  example 
that  the  set  M4x4  of  4 x 4 matrices  is  a differentiable  manifold.  Since  G is  a subset 
of  M4x4,  it  can  be  endowed  with  the  subspace  topology.  In  particular,  define  U to  be 
open  in  G if  and  only  if  there  exists  an  open  subset  V of  R”2  such  that  U = V D G. 
A differentiable  structure  for  G can  also  be  defined  to  be  that  which  is  inherited  by 
the  differentiable  structure  for  M4x4.  Thus,  G is  a differentiable  manifold.  It  remains 
only  to  check  that  the  mapping  given  by  (2.2)  is  differentiable.  It  is  easy  to  show 
that,  via  matrix  multiplication,  elements  of  the  right  hand  side  of  the  mapping  are 
simply  the  sums  and  products  of  elements  of  the  two  matrices  on  the  left  hand  side 
of  (2.2).  Thus,  G is  a Lie  group. 


CHAPTER  3 

THE  EUCLIDEAN  GROUP 


3.1  Euclidean  Space 

Three  dimensional  Euclidean  space  E3  is,  at  least  locally,  the  space  humans  live 
in.  There  are  many  ways  to  study  this  space.  The  approach  chosen  by  Euclid  was  to 
define  a series  of  geometric  objects  such  as  points,  lines,  and  planes  together  with  a set 
of  axioms  from  which  the  theorems  of  geometry  could  be  deduced.  One  noticeable 
aspect  of  this  approach  is  that  all  work  is  done  without  the  use  of  co-ordinates. 
Indeed,  the  introduction  of  co-ordinates  in  the  study  of  E3  is  artificial. 

One  particular  method  of  introducing  co-ordinates  on  E3  is  based  on  the  choice 
of  scale  or  length  for  E3,  the  selection  a point  of  E3,  and  the  preference  of  three 
mutually  perpendicular  directions.  This  induces  a bijective  mapping  of  E3  to  R3 
which  preserves  the  distances  between  points  in  E3  and  their  corresponding  points 
in  R3.  This  type  of  mapping  will  henceforth  be  called  an  orthogonal  co-ordinate 
mapping  on  E3.  It  is  important  to  observe  that  this  mapping  is  arbitrary,  as  there  is 
no  natural  way  to  identify  E3  with  R3. 

However,  given  one  such  mapping,  there  then  exists  a preferred  point  of  E3 
called  the  origin  which  is  represented  in  R3  by  the  triple 

B0  = (0,0,0). 

There  also  exist  three  preferred  and  mutually  perpendicular  directions  on  E3  which 
are  represented  in  R3  by 
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Bx  = (1,0,0) 
By  = (0,1,0) 

Bz  = (0,0,1). 
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These  four  triples  define  a frame  in  E3  and  will  henceforth  be  collectively  denoted  by 

B = (Bx,By,Bz,B0). 

This  is  the  preferred  frame  due  to  the  co-ordinate  mapping  of  E3.  All  other  frames 
are  non-preferred  and  are  expressed  in  the  following  manner:  Let 

To  — (<Jx)  /)®z); 

where  ( ax , ay,  az ) is  a triple  of  real  constants  that  represent  another  point  of  E3.  Also 
let 


Tx  = (<*11,  ^21?  «3l) 

Ty  = («12,  a22i  O32) 

Tz  ~ («13,  G23j  a33), 

where  a,j  G R for  i,j  = 1 . . . 3,  represent  three  ortho-normal  directions  of  E3.  Then 

T = (Tx,Ty,Tz,To) 

is  another  frame  in  E3. 

It  is  important  to  realise  that,  while  the  co-ordinate  expression  for  a frame  is 
dependent  on  the  co-ordinate  mapping  of  E3,  a frame  exists  as  a geometric  entity  in 
E3  independently  of  any  such  mapping.  With  this  notation,  it  is  seen  that 
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J~  x ~ a,\\Bx  + Cl2lBy  + O31  &z 

J~  y — Cl\2  Bx  + a^lBy  + a 32&Z 

F z = «13  Bx  + Q'2zBy  + «33  Bz, 


and 


3 O'X^X  T Oyf^y  “1“  ^Z^Z  + Bo. 


Symbolically,  one  writes 


T = Bsl 


where  the  right  hand  side  of  this  equation  is  the  formal  product  of  the  row  of  triples 
forming  B and  the  matrix  a defined  by 


a 11 

012 

Ol3 

&x 

021 

022 

«23 

Oy 

fl31 

^32 

«33 

a* 

0 

0 

0 

1 

The  ortho-normality  condition  requires  that 


3 

'y  1 ^ik^jk 

k= 1 


1 if  i = j 

0 if  1/  j 


for  i,j  = Thus,  the  matrix  a is  an  element  of  the  group  G of  matrices 

introduced  in  Chapter  2. 

While  the  frame  T is  expressed  in  terms  of  the  preferred  frame  B,  it  is  possible 
to  generalise  this  relationship  by  expressing  one  arbitrary  frame  in  terms  of  another. 
For  example,  let  T and  T be  frames  such  that 


T = B a and  T — Be 
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for  matrices  a,  c € G.  Then 


7 = Ba 
7 a.-1  = B 
7aTlc  — Be. 

Setting  g = a-1c  yields 

F = 7g. 

It  is  noted  that  the  element  g is  interpreted  as  mapping  the  frame  7 to  the  frame 
7.  It  does  not  involve  the  preferred  frame  B.  It  involves  an  arbitrary  element  of  G 
and  is,  thus,  invariant  with  respect  to  the  co-ordinate  chart  on  E3. 

An  arbitrary  point  of  E3,  expressed  in  the  frame  7 , is  given  by  the  triple 


Px^X  + Py7y  + PZ7Z  + 7o, 

where  px,py,pz  E R are  called  the  co-ordinates  of  the  point  in  terms  of  the  frame  7. 
Let 


' Px  ' 

’ Px  ' 

Py 

and  p = 

Py 

Pz 

Pz 

1 

1 

represent  the  column  of  co-ordinates  of  the  point  in  terms  of  the  frames  7 and  7 
respectively.  The  relationship  between  these  co-ordinates  is  given  by 
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PxFx  + PyTy  + pzTz  + Fo 

— [gwF r + Ql\<F y + Qz\J~ z)px  + [_9l2F x + 922  Fy  + g32^z]Py 
-\-[g\zF X + 92zF y + <733 -T7 z]pz  + [gxFx  + 9y^Fy  + 9zFz  + Fq] 

= [9nPx  + gi2Py  4-  9i3pz  + gx\Fx  + [g2ipx  + g22Py  + g23pz  + gy\Fy 

+ [<73lPl  + 9Z2Py  + 9zzpz  + gz\Fz  + 0 

Thus, 


p = gp 

where  the  right  hand  side  of  this  equation  is  the  formal  product  of  the  matrix  g and 
the  column  of  co-ordinates  p.  Here,  the  element  g is  interpreted  as  mapping  the 
co-ordinates  of  a point,  expressed  in  terms  of  the  frame  F,  to  the  co-ordinates  of  the 
same  point  expressed  in  terms  of  the  frame  F . 

An  arbitrary  vector  in  E3,  expressed  in  the  frame  ~F,  is  given  by  the  triple 

V XF x VyF y VZF 2, 

where  vx,vy,vz  £ R are  called  the  co-ordinates  of  the  vector  in  terms  of  the  frame 
F.  Let 


vx 

' vx  ' 

V = 

Vy 

and  v = 

vv 

vz 

vz 

. 0 . 

. 0 . 

represent  the  column  of  co-ordinates  of  the  vector  in  terms  of  the  frames  F and  F 
respectively.  The  relationship  between  these  co-ordinates  is  given  by 


vxFx  + vyFy  + vzFz 
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— [dwF r + 92\F \)  + #31  s]Ft  + [#12^ x + 922^y  + g32^z]vy 

+ [fi,13^r c + 923? y + 933^ z]vz 

— [gnvx  + 9\2Vy  + g^Vz^ r + [#2lhr  + 922^y  + 97.3V  z\f y 
+ [^31^1  + 932V  y + 933V  z]^ z 


where  the  right  hand  side  of  this  equation  is  the  formal  product  of  the  matrix  g and 
the  column  of  co-ordinates  v.  In  this  case,  the  element  g is  interpreted  as  mapping 
the  co-ordinates  of  a vector,  expressed  in  terms  of  the  frame  JF,  to  the  co-ordinates 
of  the  same  vector  expressed  in  terms  of  the  frame  T 

3.2  Rigid  Body  Motion  in  Space  and  Time 

It  has  been  shown  that  any  two  frames  in  a Euclidean  space  E3  are  related  by  an 
element  of  the  group  G of  matrices  introduced  in  Chapter  2.  One  interpretation  of 
the  Euclidean  group  is  to  consider  it  to  be  the  set  G of  all  mappings  between  frames 
in  E3.  Using  this  interpretation,  the  group  can  be  used  to  model  the  motion  of  a 
rigid  body  in  space  and  time. 

Points  connected  with  a universe  at  rest  with  respect  to  an  observer  constitute 
a three  dimensional  Euclidean  space  and  will  henceforth  be  referred  to  as  the  fixed 
space  E3.  For  kinematic  purposes,  it  suffices  to  consider  a body  in  motion  to  be 
of  infinite  extent.  Thus,  points  connected  with  a universe  at  rest  with  respect  to 
a moving  body  also  constitute  a three  dimensional  Euclidean  space  that  is  distinct 
from  the  first  and  will  henceforth  be  referred  to  as  the  moving  space  E3.  At  any  time 
the  observer  may  select  an  orthogonal  co-ordinate  mapping  on  E3  and  two  frames  in 
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E3,  one  which  will  remain  at  rest  with  respect  to  the  fixed  space  E3  and  be  called 
the  fixed  frame , and  another  which  will  remain  at  rest  with  respect  to  the  moving 

— 3 

space  E and  be  called  the  moving  frame.  If  the  fixed  frame  is  denoted  by  T and  the 
moving  frame  is  denoted  by  T then,  from  Section  3.1,  there  exists  a matrix  g € G 
mapping  the  fixed  frame  T to  the  the  moving  frame  T . Formally,  this  is  written  as 

g : F — + 

such  that 

It  is  noted  that  both  frames  are  expressed  in  terms  of  the  co-ordinate  chart  on 
the  fixed  space  E3  and,  hence,  exist  in  the  fixed  space  alone.  Thus, there  is  another 
application  for  the  Euclidean  group  when  it  is  used  as  a mapping  between  frames 
which  exist  in  the  moving  space  E . This  is  not  of  consequence  in  this  work,  as  all 
results  will  only  concern  the  observer’s  universe.  There  is,  finally,  a third  application 
for  the  Euclidean  group  when  it  is  used  as  a mapping  between  an  arbitrary  frame 
existing  in  the  fixed  space  to  an  arbitrary  frame  existing  in  the  moving  space.  This 
group  has  no  physical  consequences  as  there  is  no  natural  way  to  identify  such  frames. 
The  failure  to  recognise  these  applications,  and  the  existence  of  two  distinct  spaces, 
is  often  the  cause  of  much  confusion  of  terminology  in  the  literature. 

Now,  as  the  body  moves  in  time,  the  frame  T changes  in  time,  as  does  the 
matrix  g.  Thus,  there  is  a mapping 


R 


G 


such  that 
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This  is  interpreted  as  a curve  in  the  Euclidean  group.  An  investigation  of  the  im- 
plications of  representing  the  motion  of  a body  in  space  and  time  as  a curve  in  the 
Euclidean  group  will  be  examined  in  further  chapters. 

3.3  The  Euler  Parameterization  of  the  Euclidean  Group 

The  set  G of  matrices  acting  as  mappings  between  frames  in  E3  is  the  interpre- 
tation of  the  Euclidean  group  that  is  selected  for  this  work.  It  was  shown  in  Chapter 
2 that  this  set  is  a differentiable  manifold.  If  g € G,  then  the  requirement  that 

[g]3x3[g]3x3  = *3x3  (3.1) 

demonstrates  that  the  elements  of  the  matrix  are  not  all  independent.  Indeed,  it  is 
difficult  choose  from  them  an  independent  subset,  and  to  express  the  other  elements 
of  the  matrix  in  terms  of  this.  Thus,  the  alternate  technique  of  choosing  a local 
parameterization  of  the  manifold  involving  the  Euler  parameters  will  be  employed. 
This  is  a mapping  of 


[0,2tt)  x [0, tt)  x [0,2tt)  xR3-G 

such  that 

i — ♦ g, 

where  g satisfies  (3.1).  The  geometric  interpretation  of  these  parameters  is  achieved 
by  using  them  to  define  a sequence  of  transformations  of  the  frame  T to  the  frame 
T . Let 

'1  0 0 h ‘ 

0 10  t2 
0 0 1 <3 
0 0 0 1 


go  = 


28 


be  the  transformation  required  to  map  the  point  to  the  point  !F0.  See  Figure  3.1 
for  a depiction  of  this  mapping  and  its  relationship  to  the  Euler  parameters.  Let  T\ 
denote  the  frame  which  results  from  g0  acting  on  T . Hence, 


Tx  - .Fgo. 

Consider  the  line  of  intersection  of  the  planes  formed  by  the  pairs  of  vectors  {T\x,  TXy) 
and  {F xi  J~y).  Let  (f)  be  the  right  handed  angle  of  rotation  about  FXz  from  ^F\x  to 
this  line  of  intersection.  Define 

•^2  = ^lgl, 

where 

cos  </>  — sin  0 0 0 ' 

_ sin  $ cos  (j)  0 0 

Sl  “ 0 0 10' 

.0  0 0 1. 

Let  9 be  the  right  handed  angle  of  rotation  about  T2x  from  T2z  to  ~Ta.  Define 
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T3  = ^2g2, 


where 


g2 


10  0 0 
0 cos  8 — sin  6 0 
0 sin  9 cos  6 0 

0 0 0 0 

0 0 0 1 


Thus,  T3z  is  now  coincident  with  T z.  Also  T3x  and  TZy  lie  in  the  same  plane  as  Tx 


and  Ty.  Let  ip  be  the  right  handed  angle  of  rotation  about  T3z  from  T3x  to  Tx.  Then 


? = ^3g3, 


where 


cos  ip  — sin  0 0 
sin  ip  cos  -0  0 0 

0 0 10 

. 0 0 0 1 


Thus, 


T = ^[g0glg2g3] 


= -^g, 


where 


cos  cp  cos  ip  — sin  <p  sin  ip  cos  6 
sin  cp  cos  ip  + cos  cp  sin  ip  cos  6 
sin  ip  sin  6 
0 


— cos  <p  sin  ip  — sin  <p  cos  ip  cos  6 

— sin  i p sin  ip  -f  cos  cp  cos  ip  cos  9 

cos  ip  sin  6 
0 


sin  <p  sin  6 
— cos  <p  sin  9 
cos  9 
0 


x 

y 

z 

1 

(3.2) 


g 
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Thus,  any  element  of  the  Euclidean  group  can  be  specified  using  the  Euler 
parameters.  It  is  noted  that,  via  the  Euler  parameterization  denoted  by 

(<^,  Vh  x,  y,  z)  i — > g, 

one  does  not  achieve  a bijective  mapping.  Indeed,  when  the  a:?/-plane  of  the  frames 
T and  T are  parallel,  there  is  no  unique  value  for  (j>  and  ip.  This  is  not  of  concern 
since  the  inverse  mapping  of  an  element  of  G to  the  Euler  parameters  will  never 
be  considered.  Thus,  these  parameters  are  simply  a convenient  way  to  specify  a 
unique  element  of  the  group,  and  will  aid  in  the  study  of  its  structure  with  the  use 
of  geometrically  meaningful  angles. 


CHAPTER  4 
TANGENT  BUNDLES 

4.1  The  Tangent  Bundle  of  En  and  Rn 

Let  p be  any  point  of  three  dimensional  Euclidean  space  E3.  The  tangent  space 
of  E3  at  p,  denoted  by  TpE3,  is  described  to  be  the  set  of  all  directed  line  segments 
vp  with  p as  their  common  base.  Elements  of  the  tangent  space  TPE3  will  henceforth 
be  called  tangent  vectors.  The  addition  of  two  elements  vp,wp  6 TPE3  is  defined  to 
be  the  directed  line  segment  with  base  at  p and  with  tip  at  the  point  in  E3  resulting 
from  first  moving  in  the  direction  of  vp,  a distance  equal  to  the  length  of  vp,  and  then 
moving  in  the  direction  wp,  a distance  equal  to  the  length  of  wp.  The  negative  of  vp, 
denoted  by  — vp  is  defined  to  be  the  directed  line  segment  with  base  p,  with  length 
equal  to  that  of  vp,  and  with  direction  opposite  to  that  of  vp.  The  zero  vector  0P 
is  defined  to  be  the  null  segment  consisting  of  the  point  p alone.  Multiplication  of 
vp  £ TpE3  by  a positive  scalar  A £ R is  defined  to  be  the  directed  line  segment  with 
base  at  p and  with  tip,  at  the  point  resulting  from  moving  in  the  direction  of  vp,  a 
distance  equal  to  A times  the  length  of  vp. 

An  exercise  in  solid  geometry  will  show  that  TpE3  is  a vector  space.  Thus,  there 
exists  a vector  space,  called  the  tangent  space,  associated  with  each  point  of  E3.  The 
disjoint  union  of  the  collection  of  all  these  tangent  spaces  is  given  by 

U Trr3 

peE3 

and  is  called  the  tangent  bundle  of  E3. 
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The  goal  in  this  section  is  to  generalise  the  concept  of  a tangent  bundle  by  at- 
taching an  n-dimensional  vector  space  to  each  point  of  an  n-dimensional  differentiable 
manifold.  To  do  so,  one  must  leave  E3  and  enter  Rn,  where  the  intuitive  model  of  a 
tangent  bundle,  alluded  to  above,  is  quantified  in  terms  of  n-tuples  of  real  numbers. 

Let  p — (pi,.. . , Pn)  and  v = (iq, . . . , un)  be  two  points  of  Rn.  Then  Tp  R",  the 
tangent  space  of  Rn  at  p , is  defined  to  be  the  collection  of  pairs  of  points  given  by 

TPR"  = {(p,v)|  p,v  € Rn}. 

The  pair  (p,  v ) G Tp Rn  will  henceforth  be  called  a tangent  vector  at  p and  denoted 
by  vp.  Hence, 


(,Pl>  • • • ) Pnt  ^1?  • • • > Vn). 

This  quantity  is  interpreted  as  giving  the  initial  and  terminal  points  of  a directed  line 

segment  in  Rn,  which  starts  at  the  point  p and  ends  at  the  point  p + v,  where 

p+v  = (p  J +VU...,Pn  +t>„). 

The  addition  of  two  tangent  vectors 

UP  (Pi  > • • • » Pni  i • • ■ , Vn) 

^ P {Pi ) • • • 5 Pn  i ^1  > • • • j W n ) 

is  defined  by 

Vp  + Wp  = (pu  . . .,pn,v  1 + «?!,.  . . ,Vn  + Wn). 

Multiplication  of  vp  by  a scalar  A € R is  defined  by 


Xvp  = (pi,...,pn,At;1,...,At;n). 


The  zero  vector  is  defined  by 


0P  ee  (pi,...,p„,0,...,0). 

It  is  a simple  exercise  to  verify  that  the  above  definitions  define  an  n-dimensional 
vector  space  at  each  point  p £ Rn.  It  is  noted  that  vectors  with  different  initial 
points  are  in  no  way  equated  as  one  does  with  free  vectors  in  the  study  of  E3. 

Now  let  / : R71  — > R be  a differentiable  function  such  that 

(^i>  • • • , xn)  i > /(aq, . . . , i„). 

Let  c : R — >•  R”  be  a curve  in  Rn  such  that 


t i — > (ci(*),...,C»(*)). 


Then  the  function  /,  restricted  to  the  curve  c,  is  given  by 


/ o c : R — » R 


such  that 


t 1 — * f(ci(t),c2(t),...,cn(t)). 

If  the  curve  passes  through  the  point  p at  time  t0,  then  the  derivative  of  / o c at  p is 
given  by 


d{f  o c) 
dt 


to 


df  dc\ 
dx\  dt 


+ ...+ 


*0 


0f_  dCr, 
dxn  dt 


to 


It  is  noted  that  the  derivative  of  the  curve  c(t ) at  t0,  given  by 


(4.1) 
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is  just  a point  in  Rn,  whereas  the  directed  line  segment  from  the  point 

dc 

c(to)  to  the  point  c(to)  H — — 

dt  . 

to 

is  a line  segment  which  is  tangent  to  the  curve.  With  this  interpretation,  it  is  clear 
that  this  line  segment  is  an  element  of  the  tangent  space  of  R”  at  p.  It  will  henceforth 
be  referred  to  as  the  tangent  vector  to  the  curve  c at  time  t0.  For  brevity,  it  will  also 
be  denoted  by  the  symbol 


dc 

dt 


(4.3) 


No  confusion  will  arise  since  the  n-tuple  given  in  (4.2)  will  not  be  considered  again 
in  this  work. 

The  quantity  given  by  (4.1)  is  called  the  directional  derivative  of  / in  the  direc- 
tion of  the  tangent  vector 


dc 

dt 


to 


It  is  dependent  only  on  the  n-tuple  given  in  (4.2)  and  not  on  the  entire  curve  c(t). 
Thus,  another  curve  through  p having  the  same  tangent  vector 


dc 

dt 


to 


at  p results  in  the  same  directional  derivative.  Indeed,  letting  h(t)  be  a new  curve, 
such  that 


h(t)  = 


ci (to)  + t ~ 


*0 


at 


to J 


it  is  found  that 


d(foh) 


dt 


to 


d(foc) 

dt 


to 
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In  some  sense,  an  arbitrary  tangent  vector  vp  is  thought  of  as  acting  on  the 
function  / in  the  following  manner:  If 

VP  {Pi i • • • i Pn , Vi , . . . , Vn ) 

then 


, A df 
V = 2>^ : 

i= 1 ux' 


This  is  the  directional  derivative  of  / in  the  direction 


Letting 


^P  (.Pi  > • • • > Pn , Ul , . . . , Vn  ) . 


(4.4) 


MO  = (Pi  +tv1,...,pn  + tvn), 

then 

d(foh) 

pJ  ~ dt  * 

The  directional  derivative  has  two  key  properties  which  are  critical  to  the  study 
of  tangent  spaces:  Let  a,  f}  be  real  numbers,  and  f,g  be  differentiable  functions 
whose  domain  is  an  open  set  containing  p.  Then  the  property  of  acting  linearly  can 
be  checked  by  showing  that 


+ fa)  = avpf  + /3vpg.  (4.5) 

The  property  of  satisfying  the  Leibnitz  rule  can  be  checked  by  showing  that 

Mfp)  = M)g(p)  + f(p)(vpg).  (4.6) 

These  two  key  properties  are  now  applied  to  generalise  the  concept  of  a tangent 


vector. 
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4.2  Directional  Derivatives  as  Operators  Acting  on  Functions 

One  can  generalise  the  concept  of  a directional  derivative  to  that  of  an  operator 
acting  on  a function.  Let  C°°(p)  denote  the  collection  of  all  differentiable  functions 
whose  domain  is  an  open  subset  of  R"  containing  a point  p of  Rn.  Let  Z>(p)  denote 
the  set  of  all  operators  taking  C°°(p ) to  R which  act  linearly  and  satisfy  the  Leibnitz 
rule.  Hence,  if  D\  is  an  element  of  T>(p)  then 

D\  (af  + fig)  = otD\f  + fiDxg  linearity 

Di(fg)  = (Dif)g(p)  + f(p)(Dig)  Leibnitz 

The  elements  of  T>(p)  are  called  derivations  on  R".  Formally,  if  Dx  £ T>(p),  then 


D\  : C°°(p)  — > R. 


The  set  T>(p)  is  made  into  a vector  space  over  R by  defining  the  addition  of 
elements  of  X>(p),  and  the  multiplication  of  elements  of  T>(p)  by  a scalar,  in  the 
following  manner:  If  DX,D2  are  derivations  on  R”  and  a £ R,  then 


( D\  + D2)f  = Dxf  -f  D2f  defn.  of  addition 

(°A )/  = &D\f,  defn.  of  scalar  multiplication 

where  the  the  operations  on  the  right  hand  side  of  these  two  equations  are  in  R and 
not  T>(p). 

One  must,  of  course,  verify  that  the  operators  on  the  left  hand  side  of  these 
equations  are  also  derivations  on  Rn.  Thus,  let  a,/?, 7 £ R and  f,g  £ C°°(p).  Then 

(jDi)(af  + fig)  = i[D\(af  + fig)]  by  defn.  of  multiplication 

= 7 [aD\f  + fiD\g\  by  linearity 

= 7 aDxf  + ntfiDig 


= a(r/Di)f  + fifrDjg 


by  defn.  of  multiplication 
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and 

(7-D1  )(fg)  = n[Di(fg)] 

= l[{D\f)g(p)  + f(p)(Dig)\ 

= 7(0i  f)g(p)  + f(ph(Dig) 

= [(70i  )f]g(p)  + /(p)[(70i)sf]- 

Thus,  7 Di  is  an  element  of  T>(p).  Also, 

(0i  + D2)(af  + fig)  = Di(af  + fig)  + D2(af  + fig) 

= (a0i/  + PD\g ) + ( aD2f  + PD2g) 
= oc(Dif  + D2f)  + P{Dig  + D2g) 

— Q(0i  + D2)f  + P{D\  + 02  )g 

and 

(0!  + D2)(fg)  = 0i(/flf)  + 02(/^) 

= [(DJ)g(p)  + f(p)(Dig)} 

+[W)g(p)  + f(p)(D2g)} 


by  defn.  of  multiplication 
by  Leibnitz 

by  defn.  of  multiplication 

defn.  of  addition 
by  linearity 

by  defn.  of  addition 

by  defn.  of  addition 
by  Leibnitz 


= (0i/  + 02/)<7(p)  + /(p)(0i<7  + 02<7) 

- [(0i  + 02 )f]g(p)  + /(p)[(0i  + D2)g\.  by  defn.  of  addition 
Thus,  D\  + D2  is  an  element  of  0(p).  Hence  T>(p)  is  a vector  space. 

The  relationship  between  TpRn,  the  tangent  space  of  Rn  at  p , and  V(p),  the 
vector  space  of  derivations  on  R",  is  now  investigated.  Let  vp  G TpRn  be  interpreted 
as  an  operator  acting  on  a function  / £ C°°(p)  in  the  manner  described  by  (4.4). 
This  results  in  the  real  value  called  the  directional  derivative  of  / in  the  direction  vp. 
Thus,  as  an  operator, 


: C°°(p)  — > R. 
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Also,  by  the  properties  of  the  direction  derivative  given  in  (4.5)  and  (4.6),  vp  acts 
linearly  and  satisfies  the  Leibnitz  rule.  Thus,  elements  of  Tv Rn  are  also  derivations 
on  C°°(p ) and  hence  elements  of  T>(p).  In  turn,  it  is  claimed  that  every  derivation 
on  Rn  can  also  be  considered  to  be  a tangent  vector.  That  is,  TpRn  and  T>(p)  are,  in 
fact,  the  same  vector  space. 

To  prove  this,  it  must  be  shown  that  for  every  D E P(p)  there  is  a tangent 
vector  vp  E Tp R"  such  that 

Df  = vpf  for  every  / E C°°(p). 

Hence,  let  D be  a derivation  on  Rn.  Define 

Vi  '■  Rn  — + R 

to  be  the  ith  co-ordinate  function  such  that,  for  any  x = (x1? . . . , xn)  E R71, 

Vi(x)  = i,  ...,£„)  = Xi. 

Thus,  yi  E C°°(p)  and  one  can  define  V{  to  be  the  real  number  such  that 

Vi  = Dy{. 

Consider  the  tangent  vector  with  co-ordinates 

VP  = {Pl,-‘-,Pn,Vi,...,Vn). 

As  an  operator  on  / E C°°(p),  it  yields 

, " df , . 

vpf  = EviQ-iP)- 

!=1  ux, 

On  the  domain  of  definition  of  /,  the  function  can  also  be  represented  as 


/(.)  = m + /;  dt 


since 


df\p  + t(x 
dt 


f\p  + t(x  - p)]\]=0 
/(*)  “ f(P)- 


Hence, 


f(x) 


f-  df\p  + t(x  - p)]  d[p,-  + t(yj  - p,-)] 
—>  dxi  dt 


/(a)  + 


dt. 


p+t(x-p) 


Define 


The  functions  for  * = 1, , 


dt  for  i = 1, . . . , n. 

p+t(x-p) 

n are  elements  of  C°°(p),  where 


Thus, 


9<(P)  = g(P). 


f(x)  = f(p)  + - Pi)9i(x) 

«= i 

and 


Df  = D[f(p)  + Y,(yi  ~ Pi)gi(x )] 

i=l 
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= 0 + J2\.D(yi  - Pi)\9i(p ) + (p.- 


«=x 


df  , . 

= 

i=l  ux' 

= Vpf , 


Pi)D{gt) 


where 

^p  (Pi  > • • • ) Pn ) Vi , . . . , Un ) . 

Therefore,  every  derivation  on  R"  is  a tangent  vector  operating  on  C°°(p).  Thus, 
TpRn  and  T>(p)  are  isomorphic  vector  spaces. 

Using  this  result,  the  basis  for  TpRn,  given  by 

el|  p = (Pl,...,pn,l,0,...,0) 

Snip  = (Pit  • • • ,Pn,  0,  0,  ...  , 1), 

is  represented  by  the  operators 


d 


d 

dxn  p 

respectively,  and  is  considered  to  form  a basis  for  V(p).  Henceforth,  when  the  tangent 
vector  at  a point  p of  R”  is  referred  to,  its  dual  role  as  an  operator  on  C°°(p)  and  an 
element  of  T>(p)  will  also  be  implied. 

The  simplest  example  of  a manifold  with  a tangent  bundle  is  that  of  R.  Let 

c : R — i R 


such  that 
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t 


c(t) 


is  an  element  of  C°°(to),  for  t0  € R . This  curve  is  interpreted  as  movement  along  the 
real  in  time.  The  tangent  space  to  R at  t0  is  spanned  by  the  single  vector 


d_ 

dt 


to 


The  tangent  vector  to  the  curve  c(t)  at  time  t0  is  given  by 


dc 


dt 


to 


and  is  a vector  originating  at  the  point  c(to ) and  having  magnitude  representing  the 
speed  of  the  movement  along  the  line. 


4.3  The  Tangent  Bundle  of  Differentiable  Manifold 

The  concept  of  a tangent  bundle  is  now  generalised  by  attaching  an 
n-dimensional  vector  space  to  each  point  of  an  n-dimensional  differentiable  mani- 
fold. Let  M be  such  a manifold.  Let  V be  an  open  subset  of  M,  and  let  / be  a 
function  such  that 


/ •'  V — * R. 

Let  (U,x)  be  a co-ordinate  chart  on  M such  that  U fl  V / Then  / is  called 
differentiable  if  and  only  if 


fox  1 : x(U  D V)  — * R 

is  differentiable.  See  Figure  4.1  for  a depiction  of  this  mapping.  It  is  noted  that 
x(U  n V ) is  an  open  subset  of  Rn,  since  the  co-ordinate  chart  x is  a homeomorphism 
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Figure  4.1.  Differentiability  on  a Manifold 


of  U to  x(U).  Thus,  the  question  of  differentiability  has  effectively  been  transferred 
from  the  manifold  back  to  R".  As  in  the  case  of  R",  one  defines  C°°(p ) to  be  the 
collection  of  differentiable  functions  whose  domain  is  an  open  subset  of  M containing 
a point  p of  M. 

Let  / : Mm  — ► Nn  be  a mapping  of  an  m to  n-dimensional  differentiable 
manifold.  Then  / is  called  differentiable  if  and  only  if  for  every  p E M there  exist 
co-ordinate  charts  (U,x),(V,y)  containing  p,f(p)  respectively  such  that  1/  C f(U), 
and  the  mapping 


yofox  1 : x(U)  — ♦ y(V) 

is  differentiable.  Here,  x(U)  is  an  open  subset  of  Rm  and  y(V)  is  an  open  subset  of 
Rn  See  Figure  4.2  for  a depiction  of  this  mapping. 

The  tangent  space  to  M at  p is  denoted  by  TpM  and  is  defined  in  the  following 
manner:  Let  a, /?  £ R and  f,g  E C°°{p).  Then  vp,wp  E C°°(p)  are  operators  such 


that 
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Figure  4.2.  Differentiability  Between  Manifolds 


up  : C°°(p) 


R 


and  satisfy  the  conditions 


vP(af  + fig)  = avpf  + fivpg  (4.7) 

and 

vp(fg)  = M)g(p)  + f(p)(vpg).  (4.8) 

As  in  the  case  of  TpR",  TPM  is  made  into  a vector  space  by  defining  the  addition 
of  elements  of  TpM , and  the  multiplication  of  elements  of  TpM  by  a scalar  in  the 
following  manner:  If  vi,v2  are  elements  of  TPM,  and  a e R,  then  define 


(«1  + V2)f  = Vi  f + v2f 


(4.9) 
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(avx)f  = ot(vif ) (4.10) 

The  elements  of  this  tangent  space  are  again  called  tangent  vectors.  It  can  easily 
be  checked  that,  together  with  the  definitions  given  in  (4.9)  and  (4.10),  and  the 
properties  given  in  (4.7)  and  (4.8),  TPM  satisfies  the  definition  of  a vector  space. 
Thus,  there  exists  a vector  space,  called  the  tangent  space,  associated  with  each 
point  of  a differentiable  manifold.  The  disjoint  union  of  the  collection  of  all  these 
tangent  spaces,  given  by 


U TrM, 

p£M 

is  called  the  tangent  bundle  of  M. 

Derivations  on  a manifold  do  not  lend  themselves  to  a geometric  interpretation 
as  readily  as  derivations  on  Rn.  Thus,  one  transfers  the  action  of  a derivations  on  M 
to  that  of  an  action  on  Rn.  This  is  done  in  the  following  manner:  Let  F : M — > N 
be  a differentiable  mapping  of  manifolds.  Let  vp  G TpM  and  / G C°°(F(p)).  Define 

F*  : TPM  — ► 7V(P)M 

such  that 

( F*vp)f  = vp(f  o F). 

It  is  claimed  that  this  is  a linear  mapping  of  tangent  spaces. 

It  is  first  shown  that  F+vp  is,  in  fact,  an  element  of  Tp^M . That  is,  F*vp  must 
satisfy  (4.7)  and  (4.8).  Let  a,/?  G R and  f,g  G C°°(F(p)).  Then 


( Fmvp)(af  + [3g ) — vp[(af  + f3g)  o T1] 
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= vp[a(f  ° F)  + (3(g  o F)\ 
= avp(f  o F)  + /3vp(f  o F ) 
= a(F„vp)f  + /3(F*vp)g. 

Hence,  F+vp  acts  linearly  on  functions.  Also 


(F*vr)(fs)  = ’'pVf'J)  0 F\ 

= vp{(f  ° F)(g  o F)} 

= M/  0 F )]s(e(p))  + f(F(p))v„(g  o F) 

= Wvr)f]g(F(p))  + f(F(p))[(F.vp)g). 

Hence,  F*vp  satisfies  the  Leibnitz  property. 

Finally,  the  mapping  F*  must  also  be  shown  to  preserve  the  addition  and  scalar 
multiplication  properties  of  vector  spaces.  Thus,  let  a,  /?  G R and  vp,  wp  € TPM  and 
/ G C°°F{p).  Then 

[F*(otvp  + /3wp)}f  = (avp  + 0wp)(f  o F) 

= OLVp(f  o F)  + /3wp(f  o F) 

= a(F*vp)f  + f3(FtWp)f 
= [ a(Fmvp ) + f3(FmWp)]f. 

Thus  F » is  a linear  mapping  of  tangent  spaces. 

The  mapping  F * is  called  the  tangential  mapping  induced  by  F . It  has  one 

immediate  property  which  shall  be  demonstrated.  If  F : L — ► M and  G : M * N, 

then  Go  F : L — > N.  Hence,  if  vv  G TPL  and  / G C°°(G(F(p))  , then 
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[(GoF)mvp]f  = vp(f  o G o F) 
= (F.vp){foG) 
= [G.(F.vp)]f 
= [(G.  o Fm)vp]f. 


That  is, 


( G o F)»  = G*  o F„.  (4-11) 

The  geometric  interpretation  of  the  tangential  mapping  is  now  examined.  Let 
(U,x)  be  a co-ordinate  chart  on  M containing  p.  Since  x is  differentiable,  it  induces 
the  tangential  mapping 

x»  : TPM  — ► Tx(p)Rn 

such  that  for  vp  € TPM  and  / G C°°(x(p)), 


(x*Vp)f  = vp(f  ox).  (4.12) 

Since  x : U — » x(U)  is  a homeomorphism,  then  x o x_1  is  the  identity  mapping  on 
x(f7)  and  x_1  o x is  the  identity  mapping  on  U.  Thus, 

(x  o x-1),  = x»  o x”1 

by  (4.11),  which  is  just  the  identity  transformation  on  Tx(p)Rn.  Also 

(x-1  o x)*  = x~l  o x, 

by  (4.11),  which  is  just  the  identity  transformation  on  TPM.  Hence,  x»  is  a vector 
space  isomorphism  of  Tp  to  Tx{p)  and  one  can  conclude  that  TpM  is  of  dimension  n. 
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To  be  meaningful,  this  mapping  should  be  invariant  with  respect  to  the  local 
co-ordinate  chart  chosen.  Thus,  an  examination  of  an  explicit  representation  of  this 
mapping  in  different  local  co-ordinates  is  useful.  This  may  also  help  in  achieving  a 
geometric  interpretation  of  the  tangential  mapping. 

Let  x : U — *■  R”,  and  p € U,  such  that 

x(p)  = (®i(p),  •••,*«(?))• 

Let  ni  : Rn  — > R be  the  ith  co  -ordinate  function  on  Rn  such  that 


• • • i ®n)  — ®i- 


Define  x,  = 7rt-  o x to  be  the  ith  co-ordinate  function  on  U.  If  vp  is  a tangent  vector 
in  TPM , then  x,up  is  a tangent  vector  in  TpR".  From  the  analysis  of  derivations  on 
R"  given  in  Section  4.2,  it  is  known  that  x„vp  has  the  form 


" d 
x'v v = £ ^ nT T 

.=1  uxt 


x(p) 


for  real  constants  Vi,...,vn.  These  constants  are  called  the  directional  components 
of  vp  with  respect  to  the  co-ordinate  chart  (17,  x).  Indeed, 


Vi  = (x*up)(7r,)  = vp(iri  ox)  = vp(xi).  (4.13) 

If  (U,x)  and  (V,y)  are  both  co-ordinate  charts  containing  p,  then  x„up  and  y„vp  have 
the  form 


A d 

X*VP  = 

i=l  ®X' 


x(p) 


n 8 
y*vp  = Y,h  jr 
,= i dy* 


x(p) 


(4.14) 
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respectively  for  real  constants  o for  i — 1 These  expressions  must  rep- 


resent  the  same  vector  in  terms  of  the  co- 

-ordinate  charts  systems  (U,x)  and  (V,  y). 

Furthermore, 

Pi  = vP(yi) 

by  (4.13) 

= vp(yi  o x_1  o x) 

= (x*vp)(yi  ox'1) 

by  (4.12) 

— 'Tn  n 9(W°X-1)| 

^j=l  3 \x{p)  ■ 

by  (4.14) 

It  is  noted  that 


d(yi ,ox  *) 
dxi 

J - nXra 

is  the  Jacobian  matrix  of  the  R"  to  Rn  function  y o x_1,  Hence,  one  can  conclude 
that  the  representation  of  a tangent  vector  in  a particular  co-ordinate  system  changes 
according  to  the  Jacobian  of  the  co-ordinate  transformation. 

The  geometric  interpretation  of  the  tangential  mapping  and  its  effect  on  tangent 
vectors  is  illustrated  by  a simple  example.  Let 

c : R — > M 

be  a curve  in  a manifold  Af,  through  the  point  p such  that  p = c(t0).  Then  c,  is  the 
mapping  given  by 


Ti0R 


TPM 


such  that 


d_ 

dt 


d_ 

dt 


to 


to 
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Let  (t/,x)  be  a co-ordinate  chart  containing  p.  Then  the  directional  components  of 
the  above  vector  with  respect  to  the  co-ordinate  chart  (£/,  x ) are  given  by  (4.13)  which 
yields 


where  c;  = x,-  o c.  It  is  noted  that 


(xoc)(<)  = (ci  c„(t)) 


are  the  co-ordinates  of  the  curve  c(t)  with  respect  to  the  co-ordinate  system  (U,x). 
Thus,  the  directional  components  of  the  tangent  vector  to  (x  o c)(£)  are  given  by 


is  the  tangent  vector  to  the  curve  c(f)  at  time  to.  See  Figure  4.3  for  a depiction  of 
this  mapping. 

Now,  if  F : M — > N is  a differentiable  mapping  of  manifolds,  then  c(t)  is  a 
curve  in  M,  and  (F  o c)(t)  is  a curve  in  N.  Let  p = c(f0)  and  q = (F  o c)(t0).  Define 

d 


to  be  the  tangent  vector  to  c(t)  at  time  t0  and 


Thus, 


d 


to 


50 


to  be  the  tangent  vector  to  (F  o c)(t)  at  time  t0.  Then 


/'*  Up 


<Fo‘>-S 


Wq. 


Let  (U,x),  (V,y)  be  co-ordinate  charts  on  M and  N containing  p and  q respectively. 
Then 


y o F o x 1 : RTO  — ► Rn 

is  the  co-ordinate  representation  of  F with  respect  to  (U,x)  and  (V,y).  Let  v{  and 
wi  be  the  directional  components  of  vp  and  wq  with  respect  to  (U,x)  and  (V,y) 
respectively.  Then 
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Here, 


Wi  = 


r°c>-s 

d(yi  o F o c) 


Vi 


dt 


t0' 


to 


d(t)i  o F o x 1 o i o c) 
dt 


yr  d(yj  o F ox  *) 
c)x  ■ 

j= 1 ux3 

y,  d{yi  o F ox~l) 
r)x  ■ 

j=l 


<0 

d(xj  o c ) 


dt 


to 


d°j 

dt 


to 


= E 

3 = 1 


d(yi  o F o x 1 ) 


dxj 


p . 


Vj. 


d(yi  oFox  *) 
dx; 

J J mXn 

is  just  the  Jacobian  matrix  of  the  co-ordinate  representation  of  F with  respect  to 
(U,x)  and  (V,y).  See  Figure  4.4  for  a depiction  of  the  tangential  mapping  between 
manifolds. 
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CHAPTER  5 

THE  TANGENT  BUNDLE  OF  THE  EUCLIDEAN  GROUP 

5.1  The  Tangent  Space  at  the  Identity  Element 

One  may  recall  the  interpretation  of  the  Euclidean  group,  given  in  Section  3.2, 
as  the  set  G of  all  mappings  between  frames  in  E3.  One  may  also  recall  the  Euler 
parameterization  of  the  Euclidean  group  given  in  Section  3.3  via  the  mapping 

[0,27t)  x [0, 7r)  x [0, 27r)  x R3  — ► G 

such  that 


(<t>,0,ip,x,y,z)  i — ♦ g. 

In  particular,  let  g be  a mapping  from  a fixed  frame  T to  a moving  frame  F . 
A curve  in  the  group  is  given  by  the  mapping 

g : R — + G 


and  is  represented  symbolically  as 


S(t)  = 

In  this  Section,  such  curves  are  used  to  study  the  structure  of  TeG,  the  tangent  space 
at  the  identity  element  e of  the  Euclidean  group. 

Consider  a particular  curve  formed  by  restricting  the  Euler  parameters  such  that 
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x = y = z = 0 

cj)  = xj)  = 0 

e = t 


This  results  in  a curve  through  e and  is  represented  by 


g(0  = g(0,t,0,0,0,0). 


In  matrix  form,  this  curve  is  given  by 


1 0 0 0' 

0 cos  t — sin  t 0 
0 sin  t cos  t 0 

0 0 0 1 . 

Recalling  Figure  3.1,  it  is  seen  that  this  curve  corresponds  to  a rotation  about  the 
x-axis  of  the  fixed  frame.  The  directional  components  of  the  tangent  vector  at  e to 
this  curve  will  henceforth  be  denoted  by  u>x  and  are  given,  in  matrix  form,  by 


g(0  = 


= g(0)  = 


'0  0 0 0 

0 0-10 

0 10  0 

.0  0 0 0 


It  is  useful  to  keep  the  directional  components  of  tangent  vectors  in  matrix  form 
for  the  moment,  as  it  will  aid  in  taking  note  of  some  skew  symmetries  which  exist. 
Indeed,  it  is  observed  that  the  rotational  part  of  the  above  matrix,  corresponding  to 
the  upper  left  3x3  minor,  is  skew  symmetric. 

Next,  consider  restricting  the  parameters  such  that 


x = y = z = 0 
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0 = i 


This  results  in  a curve  through  e that  has  the  form 


«(*)  = 


cos  t 0 

0 1 

— sin  t 0 

0 0 


sint 

0 

cos  t 

0 


0 ' 
0 
0 
1 


This  curve  corresponds  to  a rotation  about  the  y-axis.  The  directional  components 
of  the  tangent  vector  at  e to  this  curve  will  henceforth  be  denoted  by  u>y  and  are 
given  by 


“v  = g(0)  = 


0 0 10' 

0 0 0 0 

-10  0 0 

0 0 0 0 


It  is  noted  that  the  upper  left  3x3  minor  is  again  skew  symmetric. 


Next,  consider  restricting  the  parameters  such  that 


x = y = z = 0 
= 9 = 0 
(f>  = t 


This  results  in  a curve  through  e that  has  the  form 


g(0  = 


cos  t 
sin  t 
0 
0 


— sin  t 0 O' 

cos  t 0 0 

0 1 0 

0 0 1 
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This  curve  corresponds  to  a rotation  about  the  z-axis.  The  directional  components 
of  the  tangent  vector  at  e to  this  curve  will  henceforth  be  denoted  by  uz  and  are 
given  by 


uz  = g(0)  = 


‘ 0 -1  0 0 " 

10  0 0 
0 0 0 0 

0 0 0 0 


The  upper  left  3x3  minor  is  again  skew  symmetric. 

The  tangent  vectors  to  curves  representing  pure  translations  through  the  identity 
element  are  examined  next.  Consider  restricting  the  parameters  such  that 


<f>  = 9 = = 0 

y = z = 0 
x = t 


This  results  in  a curve  through  e that  has  the  form 


g (0  = 


i o o t ■ 
0 10  0 
0 0 10 
0 0 0 1 


This  cuive  corresponds  to  a translation  along  the  a;-axis.  The  directional  components 
of  the  tangent  vector  at  e to  this  curve  will  henceforth  be  denoted  by  vx  and  are  given 
by 


.0  0 0 1' 

0 0 0 0 

0 0 0 0 

0 0 0 0 


v*  = g(0)  = 
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Similarly,  the  directional  components  of  the  tangent  vectors  at  e to  curves  cor- 
responding to  translations  along  the  y-axis  and  z-axis  will  henceforth  be  denoted  by 
vy  and  vz  respectively  and  are  given  by 

' 0 0 0 0' 

0 0 0 1 
Vy  0 0 0 0 
.0000. 

and 

' 0 0 0 0 ' 

0 0 0 0 
0 0 0 1 
.0  0 0 0. 

respectively. 

For  convenience,  the  directional  components  given  by  the  set 

if^xi  My  1 ^zi  Vxi  Vy,  vz),  (5.1) 

will  often  be  identified  with  the  tangent  vectors  themselves,  though  it  should  be  un- 
derstood that  a tangent  vector  formally  consists  of  a pair  of  matrices,  one  containing 
positional  components,  and  the  other  containing  directional  components. 

It  is  claimed  that  the  tangent  vector  at  e to  any  differentiable  curve  through  e 
is  composed  of  a linear  combination  of  (5.1).  That  is,  this  set  forms  a basis  for  Te G. 
Before  this  claim  is  justified,  it  is  necessary  to  introduce  some  additional  concepts. 

5.2  The  Right  Tangential  Mapping 

Let  an  element  g G G represent  a mapping  from  a fixed  frame  Tx  to  a moving 
frame  Ti-  Let  h 6 G.  Let 
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Rh  : G 


G 


be  defined  by 


g i — > gh. 

This  mapping  multiplies  an  arbitrary  element  of  the  group,  on  the  right  by  the  given 
element  h.  If  g = g (t)  is  a curve  in  G,  interpreted  as  the  motion  of  a body  in  space 
and  time  with  respect  to  the  fixed  frame  T\  and  the  moving  frame  T21  then 

#h(g  (0)  = g(*)h  (5.2) 

is  also  a curve  in  G and  is  interpreted  as  the  same  motion  of  the  body,  but  with 
respect  to  different  frames  of  reference.  Indeed,  let  be  a frame  at  rest  with  respect 
to  the  moving  space  such  that 


F 2 -R 3-  (5.3) 

The  curve  i?h(g(t))  then  results  in 

8(0  sr~  h 
J 1 1 * vT 2 1 > 3- 

Thus,  Rh(g(t))  is  interpreted  as  representing  the  same  motion  of  the  body,  but  with 
respect  to  T\  and  T3.  Here,  the  change  in  the  frame  at  rest  with  respect  to  the 
moving  space  is  given  by  (5.3). 

It  can  be  checked  that  the  mapping  R^  is  differentiable  by  using  the  differentiable 
structure  for  G introduced  in  Chapter  2 and  noting  that  the  elements  comprising  the 
result  of  the  mapping  are  simply  the  sum  and  product  of  the  elements  of  the  given 
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matrix  h and  the  variable  matrix  elements  of  g.  Thus,  the  mapping  R h induces  a 
tangential  mapping  called  the  right  tangential  map , which  is  given  by 

[i?h]*  • 2g(<)G  > Tg(t)ixG.  (5.4) 

It  is  claimed  that  (5.4)  is  a bijection  of  vector  spaces.  This  is  proved  by  the  following 
argument:  Since 


[Rh  0 Rh~i]  = [-fyi-1  0 Rh]  = lG, 


then 


[f?h°#h-i]*  and  0 Rh]* 

are  both  the  identity  tangential  mapping  on  all  points  of  G.  Applying  the  rule  for 
the  composition  of  tangential  mappings  given  in  (4.11)  results  in 

[i?h  0 #h-i]»  = [i?h]*[-Rh-i]* 

and 


[Rh-1  0 Rh]*  = [-Rh-iM-Rh]*- 

Thus,  [i?h].  and  are  inverses  of  each  other,  requiring  that  (5.4)  be  a bijection. 

Furthermore,  since  all  tangential  mappings  preserve  the  properties  of  addition  and 
scalar  multiplication,  [i?h]*  is  a vector  space  isomorphism. 

Now,  consider  a time  t0  and  the  tangent  vector  to  the  curve  g(f)  at  t0.  This  is 
an  element  of  Tg(to)G,  and  is  given  by 


dt 


to 


= g(<o)- 


(5.5) 
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where  g(t0)  indicates  the  derivative  of  g with  respect  to  time,  evaluated  at  time  t0. 
Also,  consider  the  mapping 


^g-'Oo)  : G — >G 
applied  to  the  curve  g(t).  This  results  in  the  curve 

Rg-Hto)S(i)  = g(0g_1(*o). 

The  tangent  vector  to  this  curve  at  t0  is  an  element  of  Te G since  Rg-i(t0)g(to)  = e. 
Using  the  properties  of  matrix  multiplication,  this  tangent  vector  is  given  by 


4ftg-M*o)g(*)] 


dt 


*0 


<*[g(*)g  *(*0)] 
dt 

g_1(*o) 


*0 


^g 

dt 


to 


= g(<o)g  (to)- 


(5.6) 


Upon  replacing  h with  g 1(t0)  in  (5.4),  it  is  seen  that  the  induced  right  tangential 
mapping  acting  at  g(to)  is  a vector  space  isomorphism  defined  by 


[-^g-1(<o)]*  : rg(to)G  — + TeG. 

From  the  properties  of  the  tangential  mapping  given  in  Section  4.3,  it  is  observed 
that  the  mapping  acting  on  (5.5)  yields  (5.6).  That  is, 


iRg-Ht0)]*g(to)  = g(<o)g  1 (t0)  • (5.7) 

This  tangent  vector  shall  henceforth  be  called  the  fixed  generalised  axode  of  the  curve 
g (0  and  will  be  denoted  by  X(^o).  It  will  be  shown  to  be  a generalisation  of 
the  concept  of  an  axode  encountered  in  screw  theory. 
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If  g (t)  is  interpreted  as  the  motion  of  a body  in  space  and  time,  the  fixed 
generalised  axode  of  the  body  at  any  time  t is  given  by 


X(<)  = [fla-i(t)]*g(0 

= g(*)g_1(0- 

This  is  interpreted  as  a vector  curve  in  TeG. 

Since  g (t)  is  the  tangent  vector  to  the  curve  g (t)  at  the  point  g(t),  it  must  be  a 
linear  combination  of  a set  of  basis  vectors  for  Tg(t)G.  By  the  isomorphic  tangential 
mapping  given  in  (5.7),  X(<)  must  be  a linear  combination  of  a basis  for  TeG.  It  is 
claimed  that,  in  particular,  it  is  a linear  combination  of  the  vectors  u )x,uy,uz,  vx,  vy,  vz 
summarised  in  (5.1).  Indeed,  since  the  curve  g (t)  is  arbitrary,  and  X(£)  is  the  image 
of  the  tangent  vector  g (t)  via  (5.7),  then  (5.1)  must  form  a basis  for  reG. 

Before  this  is  proved,  it  may  be  helpful  to  calculate  the  fixed  generalised  axode  of 
a particular  motion  and  demonstrate  its  physical  interpretation.  Consider  a cylinder 
of  radius  r rolling  along  a flat  surface.  This  motion  is  represented  by  the  relative 
motion  of  the  frame  7 with  respect  to  the  frame  7.  The  frame  7 is  defined  to  be  at 
rest  with  respect  to  the  cylinder,  whose  points  are  identified  with  the  moving  space 

— 3 

E . The  frame  7 is  defined  to  be  at  rest  with  respect  to  the  observer  who  is  identified 
with  the  fixed  space  E3.  Let  7 be  chosen  such  that  70  lies  on  the  axis  of  the  cylinder 
and  7 x is  parallel  to  the  axis  of  the  cylinder.  Also,  let  7 be  chosen  such  that  7 and 
7 aie  coincident  at  time  t = 0.  See  Figure  5.1  for  a depiction  of  these  frames  and 
the  cylinder. 

With  this  choice  of  frames,  let  g (<)  represent  the  mapping  of  the  frame  7 to  7, 
and  be  given  by 
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g(<o) 


Then,  at  time  t , 


10  0 0 

0 cos  9{t)  — sin#(f)  — rd(t ) 

0 sin#(t)  cos  6{t)  0 

0 0 0 1 


(5.8) 


x(0  = g(0g_1W 


' 0 

0 

0 

0 

' 1 

0 

0 

0 

0 

— sin  60 

— cos  66 

—rd 

0 

cos  6 

sin# 

rd  cos  6 

0 

cos  60 

— sin  66 

0 

0 

—sinO 

cos  6 

—rd  sin  6 

0 

0 

0 

0 

t 

. 0 

0 

0 

1 

' 0 0 0 O' 

0 0—1  — r i 

0 10  rd  **’ 

.0  0 0 0 

Thus,  X(t)  can  be  written  as  a linear  combination  of  the  vectors  wx,u?y,u;z,vx,Vy,vz 
summarised  in  (5.1)  which  yields 


X(t)  = {[wj  - r[uv]  + r6(t)[vz]}9(t). 

Alternately,  if  X(t)  is  written  as  the  ordered  column  of  scalar  multiples  of 
u>x,Uy,u)z,vx,vy,vz  of  which  it  is  composed,  one  finds 
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X(<) 


1 

0 

0 

0 


m- 


—r 
rO(t ) 

The  physical  interpretation  of  X(t)  is  now  more  apparent.  The  first  three  com- 
ponents represent  the  angular  velocity  of  the  cylinder  at  the  given  time.  Recalling 
that  that  one  can  identify  the  body  with  the  moving  space,  thus  making  the  as- 
sumption that  the  cylinder  is  of  infinite  extent,  it  is  seen  that  last  three  components 
represent  the  translational  velocity  of  the  point  in  the  cylinder  that  is  co-incident 
with  the  fixed  frame  at  the  given  time.  It  is  noted  that  all  the  components  of  the 
fixed  generalised  axode  are  given  in  terms  of  the  fixed  frame. 

It  is  now  proved  that  wt,w y,uz,  vx,  vy,  vz  are,  in  fact,  a basis  for  TeG.  Since  g(f) 
can  be  rewritten  as 


g(*o) 


dgdy  dgdz 

d(f>  dt  dO  dt  dtp  dt  dx  dt  dy  dt  dz  dt  ’ 


it  is  seen  that  X(t)  is  composed  of  the  sum  of  the  following  six  components: 


(5.9) 


' 0 

-1 

0 

y 

dgdp 

— 1 / . \ 

l 

0 

0 

—x 

d(p  dt 

g (0  = 

t 

0 

0 

0 

0 

. 0 

0 

0 

0 

' 0 

0 

sin  <p 

— z sin  <p 

dg  dO 

0 

0 

— cos  (p 

z cos  <p 

dOdt 

g — 

t 

— sin  (p 

cos  <p 

0 

x sin  <p  — y cos  <p 

0 

0 

0 

0 

dg  dip 
dip  dt 


g -\t)  = 
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0 — cos  9 — cos  <j>  sin  9 

cos  9 0 — sin  <p  sin  9 

cos  (j)  sin  9 sin  (p  sin  6 0 

0 0 0 


y cos  9 + z cos  <j>  sin  9 
—x  cos  9 + z sin  <f>  sin  9 
-x  cos  (f>  sin  9 — y sin  <p  sin  9 
0 


J t 


0 0 0 1 


dg  dx 

-1  /_£  \ 

0 

0 

0 

0 

dx  dt 

g" 

(<)  = 

0 

0 

0 

0 

. 0 

0 

0 

0 . 

■ 0 

0 

0 

0 ■ 

dgdy' 

0 

0 

0 

1 

dy  dt 

g' 

t 

(0  = 

0 

0 

0 

0 

. 0 

0 

0 

0 . 

0 

0 

0 

0 ■ 

dg  dz 

0 

0 

0 

0 

dz  dt 

g" 

t 

(<)  = 

0 

0 

0 

1 

0 

0 

0 

0 . 

xt 


yt 


-*  t 


Comparing  the  above  six  equations  with  the  definitions  of  ux,  wy,uz,vx,vy,vz  sum- 
marised in  5.1,  results  in  the  following  substitutions: 


dgdfi 

dp  dt 


g ~'(t) 


{[uz]  + y[vx]-x[vy]}t<j>t 


dg  d9 
d9  dt 


g ~\t) 


{cos  p[ux ] + sin  p[uy\  — z sin  <p[vx)  -f  z cos  <p[vy\ 
+(z  sin  p - y cos  p)[vz]}t9t 


dg  dp 
dip  dt 


g 


{sin  <p  sin  9[lux\  - cos  p sin  9[uy]  + cos  9[uz\ 

+(y  cos  9 -\-  z cos  <^sin  9)[vx\  — (a:  cos  9 — z sin  <^>sin  #)[uj,] 
— (xcos^sinfl  + ys\nps\n9)[vz]}txpt 
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Thus,  it  is  seen  that  (5.6)  can  be  written  as  a linear  combination  of  ix>x,uy,u>z,  vx,  vy , vz 
in  the  form 


where  Sx,  Sy,  S2,  Sox,  Soy,  Soz  are  scalar  functions  of  time.  Therefore,  the  vectors 
:iU}yi0JziVXiVy,vz  form  a basis  for  TeG.  The  scalar  functions  are  the  directional 
components  of  the  tangent  vector  X(£)  which  were  previously  contained  in  its  matrix 
representation.  For  brevity,  the  fixed  generalised  axode  will  often  be  written  as  the 
ordered  column  of  these  scalar  components.  Hence, 


m= 


cos  <f)9  + sin  (f>  sin  Otp 
sin  <j>9  — cos  <{>  sin  9ip 
(f>  + cos  9%l> 


L st 


(5.10) 


It  is  observed  that  the  fixed  generalised  axode  can  be  rewritten  as 
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X(t) 


cos  pd  + sin  p sin  dip 
sin  <p6  — cos  p sin  dp 
<p  + cos  6tp 

y(<j>  + cos  dp)  — z(sin  pd  — cos  p sin  dip)  + x 
—x(p  + cos  dip)  + z(cos  pd  + sin  <p  sin  dip)  + y 
x(sin  pd  — cos  <p  sin  dip)  — y(cos  (pd  + sin  (p  sin  dip)  -f  i 


cos  (pd  + sin  <p  sin  dp 
sin  pd  — cos  <p  sin  dip 
<p  + cos  dip 


X 

cos  pd  -f  sin  p sin  dip 

X 

y 

X 

sin  pd  — cos  p sin  dp 

+ 

y 

z 

p + cos  dp 

z 

Let  [X(<)]i  denote  the  three  components  referring  to  the  angular  velocity  of  the  body. 
Let  [X(£)]o  denote  the  three  components  referring  to  the  translational  velocity  of  the 
point  in  the  body  that  is  co-incident  with  the  fixed  frame  at  time  t.  Let  ru  represent 
the  components  of  the  position  of  the  moving  frame,  given  in  terms  of  the  fixed  frame. 
Then 


1*12  = 


x 

y 


(X(i)],  = 


cos  pd  + sin  p sin  dip 
sin  pd  — cos  p sin  dip 
p + cos  dip 


and  [X(f)]0  is  written  as 


[X(<)]o  = r12  x [X(f)]x  + r12. 

Here,  it  is  seen  that  the  translational  velocity  of  the  point  in  the  body  that  is  co- 
incident with  the  fixed  frame  is  composed  of  two  parts.  The  first  is  fX2  which  rep- 
iesents  the  translational  velocity  of  the  body.  The  second  is  r12  x [X(f)]j  which 
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represents  the  velocity,  due  to  the  rotation  of  the  moving  frame,  of  the  point  in  the 
body  that  is  co-incident  with  the  fixed  frame. 

5.3  The  Left  Tangential  Mapping 

So  far  in  the  study  of  the  tangent  bundle  of  the  Euclidean  group,  the  mapping 
f?h>  representing  multiplication  of  an  arbitrary  element  of  the  group  on  the  right  by 
the  element  h,  has  been  introduced.  This  mapping,  given  by  g (t)  and  acting  on  a 
the  motion  of  a body  in  space  and  time,  has  been  interpreted  as  the  same  motion  of 
the  body,  but  with  respect  to  different  frames  of  reference. 

In  a similar  fashion,  multiplication  of  an  arbitrary  element  of  the  group  on  the 
left  by  the  element  h,  is  analysed.  Let  an  element  g £ G represent  a mapping  from 
a fixed  frame  T\  to  a moving  frame  JF2.  Let  h € G.  Let 

Lh  : G — ► G 

be  defined  by 


g 1 — * hg- 

This  mapping  multiplies  an  arbitrary  element  of  the  group  on  the  left  by  the  given 
element  h.  If  g = g (t)  is  a curve  in  G,  interpreted  as  the  motion  of  a body  in  space 
and  time  with  respect  to  the  fixed  frame  T\  and  the  moving  frame  then 

£h(g(0)  = hg(*)  (5.11) 

is  also  a curve  in  G and  is  interpreted  as  the  same  motion  of  the  body,  but  with 
lespect  to  different  frames  of  reference.  Indeed,  let  Fq  be  a frame  at  rest  with  respect 
to  the  fixed  space  such  that 
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To  Tx. 


The  curve  Th(g(0)  then  results  in 


'V  . ti  ^ 8(0  -r- 

j 0 1 * 1 1 ► 2- 


(5.12) 


Thus,  Th(g(t))  is  interpreted  as  representing  the  same  motion  of  the  body,  but  with 
respect  to  Tq  and  JF2.  Here,  the  change  in  the  frame  at  rest  with  respect  to  the  fixed 
space  is  given  by  (5.12). 

Lh  can  be  checked  to  be  differentiable  in  the  same  manner  that  i?h  has  been. 
Thus,  it  induces  a tangential  mapping  called  the  left  tangential  mapping , which  is 
given  by 


[£h],  : Tg(t)G  — > Thg(t)G.  (5.13) 

It  is  claimed  that  (5.13)  is  a bijection  of  vector  spaces.  This  is  proved  by  the  following 
argument:  Since 

[Lh  ° Th-i]  = [Th-i  o £h]  = 1g> 

then 


[4°4-i].  and  [Th-ioZ,h], 

are  both  the  identity  tangential  mapping  on  all  points  of  G.  Applying  the  rule  for 
the  composition  of  tangential  mappings  given  in  (4.11)  results  in 

[Th  o Th-i]*  — [Th]*[-^h-i]* 


and 
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[Ih-i  ° ^h]*  = [-^h-i]»[^h]»- 

Thus,  [Th]»  and  [Th-1]*  are  inverses  of  each  other,  requiring  that  (5.13)  be  a bijection. 
Furthermore,  since  all  tangential  mappings  preserve  the  properties  of  linearity  and 
scalar  multiplication,  [T^]*  is  a vector  space  isomorphism. 

Now,  consider  the  mapping 


Lg-Hto)  '•  G — * G 

applied  to  the  curve  g(£).  This  results  in  the  curve 

Lg-Hto)S(t)  = g-1(*o)g  (<)• 

The  tangent  vector  to  this  curve  at  t0  is  an  element  of  TeG  since  Tg_i(to)g(£0)  = e. 
Using  the  properties  of  matrix  multiplication,  this  tangent  vector  is  given  by 


d[Lg-Hto)S(t)] 

dt 


dt 

= . 


= g (<o)g(<o). 


(5.14) 


The  induced  left  tangential  mapping  acting  at  g(^o)  is  a vector  space  isomor- 
phism defined  by 


[^g^fio)]*  : 2g(<o)G  — * TeG. 


Fiom  the  pioperties  of  tangential  mapping  given  in  Section  4.3,  it  is  observed  that 
the  mapping  acting  on  (5.5)  yields  (5.14).  That  is, 
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[is-1(‘o)]*g(<o)  = g 1(t0)g(t0).  (5.15) 

This  tangent  vector  shall  henceforth  be  called  the  moving  generalised  axode  of  the 
curve  g (t)  at  t0  and  will  be  denoted  by  X(t0).  It  will  be  shown,  in  the  next  chapter, 
that  this  tangent  vector  is  intimately  related  to  the  fixed  generalised  axode. 

If  g(t)  is  interpreted  as  the  motion  of  a body  in  space  and  time,  the  moving 
generalised  axode  of  the  body  at  any  time  t is  given  by 


x(<)  = [VmoUW 

= g-1(0g(0- 

This  is  interpreted  as  a vector  curve  in  TeG.  Hence  it  must  also  be  a linear  combi- 
nation of  the  vectors  u>x,ojy,u>z,vx,vy,vz  summarised  in  (5.1). 

Before  this  is  shown,  it  may  be  helpful  to  calculate  the  moving  generalised  axode 
of  a particular  motion  and  demonstrate  its  physical  interpretation.  Consider,  again, 
the  cylinder  analysed  in  Section  5.2.  This  is  depicted  in  Figure  5.1  and  parameterized 
by  (5.8).  Then,  at  time  t , 


x(0  = g (<)g(<) 


1 

0 

0 

0 

' 0 

0 

0 

0 

0 

cos  6{t) 

sin  8{t ) 

r8(t ) cos  6(t) 

0 

— sin  88 

— cos  86 

r8 

0 

— sin6(t ) 

cos  6{t) 

— r$(t ) sin  8{t) 

0 

cos  68 

— sin  66 

0 

0 

0 

0 

1 

t 

. 0 

0 

0 

0 

0 

0 

0 

0 


0 

-1 

0 

0 


0 

— r cos  6{t) 
rsin  8(t ) 

0 


Thus,  X(i),  written  as  a linear  combination  of  the  basis  vectors  summarised  in  (5.1), 
yields 
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X(f)  = ([u;x]  - r cos  9(t)[vy]  + r sin  0(f)[uj])0(i). 


Alternately,  X(t)  can  be  written  as 


m = 


i 

0 

0 

0 


— r cos  9(t) 
r sin  9{t ) 

The  physical  interpretation  of  X(t)  is  now  more  apparent.  The  first  three  com- 
ponents represent  the  angular  velocity  of  the  cylinder  at  the  given  time.  In  this  case 
they  are  given  in  terms  of  the  moving  frame.  The  last  three  components  represent 
the  translational  velocity  of  the  point  in  the  cylinder  that  is  co-incident  with  the 
moving  frame  at  the  given  time.  These  are  also  given  in  terms  of  the  moving  frame. 
Thus,  it  is  noted  that  all  components  of  the  moving  generalised  axode  are  given  in 
terms  of  the  moving  frame. 

An  explicit  expression  for  X(f)  is  calculated  by  a manner  similar  to  that  of  X(f). 
Since  g(<0)  is  given  by  (5.9)  then  X(<0)  is  composed  of  the  sum  of  the  following  six 
components: 


0 

— cos  9 

cos 

r/>sin# 

0 ' 

dg  d(j> 

cos  9 

0 

—simp  sin  9 

0 

d<p  dt 

t 

— cos  rp  sin  9 

sinV’sintf 

0 

0 

0 

0 

0 

1 . 

' 0 

0 

sin  ip 

0 ' 

g -x(0 

dg  d9 

0 

0 - 

cos  xp 

0 

9t 

J~9~dt 

t 

sin  ip 

cos  ip 

0 

0 

0 

0 

0 

1 . 

t 

<i>t 
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g -\t) 


dg  dip 
dip  dt  t 


’ 0 -1  0 O' 
10  0 0 
0 0 0 0 
0 0 0 1 


A 


g-1^) 


dg  dx 
dx  dt 


0 

0 

0 

cos  <p  cos  ip  — sin  (p  sin  ip  cos  0 

0 

0 

0 

— cos  <p  sin  ip  — sin  (p  cos  ip  cos  0 

0 

0 

0 

sin  <p  sin  0 

0 

0 

0 

1 

g -\t) 


dgdy 
dy  dt  t 


0 

0 

0 

sin  <p  cos  ip  cos  <p  sin  ip  cos  0 

0 

0 

0 

— sin  <p  sin  ip  + cos  (p  cos  ip  cos  0 

0 

0 

0 

— cos  <p  sin  0 

0 

0 

0 

1 

g ~\t) 


dg  dz 
dz  dt 


0 0 0 sim/>sin0 
0 0 0 cos  ip  sin  0 
0 0 0 cos  9 
0 0 0 1 


Comparing  the  above  six  equations  with  the  definitions  of  vx,0Jy,u>2,vx,vy,v; 


marised  in  5.1,  results  in  the  following  substitutions: 


g ~\t) 


dgd4 

d<p  dt 


{-  sin  ip0  sin  0Q[ux]  + cos  ip0  sin  0Q[uy\  + cos  90[uz]}<p, 


g -\t) 


dg  d6 
d9  dt 


{cos  ip[ux\  - sin  ip[uy]}0t 


g-1^) 


dg  dip 
dip  dt 


[uz]ipt 


sum- 
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g-1^) 


dg  dx 
dx  dt 


{ (cos  <j>  cos  xp  — sin  cp  sin  xp  cos  6)  [ux] 

+ (—  cos  ^ sin  -0  — sin^cos  ipcosQ)[vy] 
+ sin  <^sin  0[uz]}i* 


g-\t) 

+(—  sin  <^>  sin  xp  -f  cos  <^>cos  xp  cos  0)[v y\ 
— cos  <p  sin  0[vz]}yt 


dg  dy 
dy  dt 


= {(sin  <^>cos  xp  + cos  <^sin  xp  cos  0)[vx\ 


g (0 


dg  dz 
dz  dt 


= {sinV>sin0[nx]  + cos  xp  sin0[t>y]  + cos  0[u2]}it. 


Thus,  it  is  seen  that  (5.14)  can  be  written  as  a linear  combination  of 
ux,L)y,u>z,vx,vy,vz  in  the  form 


X(<)  — (dXUJx  + SyUJy  + SZUZ  + SOXVX  + S0yVy  + SOZVZ)(t), 

where  Sx,  Sy,  Sz,  Sox,  Soy,  Soz  are  scalar  functions  of  time.  Alternately,  X(t)  can  be 
written  as 


X(t)  = 


- sin  xp  sin  6<p  + cos  xp6 
cos  xp  sin  6<p  — sin  xpO 
cos  0<p  -f  xp 

(cos  (p  cos  xp  — sirup  sin  xp  cos  6)x  -f  (sin  <p  cos  xp  + cos  <p  sin  xp  cos  6)y  -f  sin  xp  sin  6z 
(—  cos  <p  sin  xp  — sin  (p  cos  xp  cos  6)x  + (—  sin  (/>sin  xp  + cos  <p  cos  xp  cos  0)y  + cos  xp  sin  6z 

sin  <p  sin  6x  - cos  <p  sin  6 y + cos  Oz 


(5.16) 
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It  can  be  checked  that 


[X(t)]i 


— sin  ip  sin  Ocp  + cos  xpd 
cos  xp  sin  6<p  — sin  xpO 


- 

cos 

6<p  + Xp 

t 

' 011 

021 

031 

cos  (pO  + sin  <p  sin  6xp 

012 

022 

032 

sin  (pO  — cos  (p  sin  dip 

. 013 

023 

033 

t 

<p  + cos  Oxp 

~ [g  1(0]3x3[X(t)]i. 


Also, 


[X(*)]o  = 


(cos  <p  cos  xp  - sin  (p  sin  xp  cos  0)x  + (sin  cos  xp  + cos  (p  sin  xp  cos  0)y  + sin  xp  sin  Oz 
(—  cos  <p  sin  xp  — sin  <pcos  xpcos  0)x  + (—  sin  (p  sin  xp  + cos  cos  xp  cos  0)y  + cos  xp  sin  Oz 

sin  <p  sin  Ox  — cos  <p  sin  0 y + cos  Oz 


9 li®  92\y  gz\z 

9ui  g22y  g^z 

913 X g239  933Z 


t 


= [g  1(<)]3xsh2, 


where  rJ2  represents  the  components  of  the  position  of  the  moving  frame,  given  in 
terms  of  the  fixed  frame.  This  vector  was  first  used  at  the  end  of  Section  5.2. 

Recalling  the  relationship  between  the  change  in  co-ordinates  of  a vector  with 
respect  to  two  different  frames,  which  was  demonstrated  in  Section  3.1,  it  is  seen  that 
[*(<)]i  and  [*(*)]!  are  the  components  of  the  angular  velocity  vector  of  the  body, 
given  in  terms  of  the  fixed  frame  and  moving  frame  respectively. 
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Also,  [X(<)]0  is  simply  the  components  of  the  translational  velocity  of  the  moving 
frame  with  respect  to  the  fixed  frame,  given  in  terms  of  the  moving  frame.  This  is 
again  just  the  translational  velocity  of  a point  in  the  body  that  is  co-incident  with 
the  moving  frame. 

Thus,  it  is  seen  that  both  generalised  axodes  are  interpreted  in  the  same  way 
physically,  but  with  respect  to  different  frames  or  reference. 


CHAPTER  6 
THE  ADJOINT  MAP 

6.1  The  Composition  of  Mappings 

In  Section  5.2  and  5.3,  two  special  cases  involving  the  composition  of  elements 
of  G were  used  to  derive  expressions  for  the  fixed  and  moving  generalised  axodes. 
In  this  chapter,  the  composition  of  elements  of  G are  analysed  in  more  detail.  The 
fixed  and  moving  generalised  axodes  of  the  motion  of  a body  in  space  and  time  are 
seen  to  be  affected  by  the  two  special  cases  of  composition.  The  relationship  between 
these  two  axodes,  briefly  introduced  in  Section  5.3,  is  explored  more  deeply.  Finally, 
it  is  shown  that  these  axodes  are  actually  two  special  examples  of  a generalised  axode 
and  that,  in  fact,  there  exists  a generalised  axode  associated  with  each  selection  of  a 
frame  in  the  fixed  space. 

Let  gi(t)  be  the  mapping  of  the  frame  To  to  the  frame  T\  as  a function  of  time. 
Then 

To  ^ Ti. 

Let  g2(f)  be  the  mapping  of  the  frame  T to  the  frame  T2  as  a function  of  time.  Then 

T ^ t2. 

The  composition  gi(*)g2(*)  is  then  a mapping  of  the  frame  T0  to  the  frame  T2  as  a 
function  of  time.  That  is, 

T0  ^ jr2. 
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Physically,  this  is  interpreted  in  the  following  manner:  Define  T2  be  a frame  at 

=3 

rest  with  respect  to  a Euclidean  space  E . Define  T\  be  a frame  at  rest  with  respect 

— 3 

to  a Euclidean  space  E . Define  Fo  be  a frame  at  rest  with  respect  to  a Euclidean 

— 3 

space  E3.  Then  the  motion  of  the  space  E with  respect  to  the  space  E3  is  given  by 
the  mapping  gi(t)g2(f)  of  the  frame  Tq  to  the  frame  T2. 

As  a simple  example,  let  g 2(t)  be  given  by 


8a(0  = 


and  let  gi(t)  be  given  by 


10  0 0 

0 cos  6(t)  —sin  6(t)  0 

0 sin  9(t)  cos  6{t)  0 

0 0 0 1 


(6.1) 


gi(0  = 


1 

o 

o 

0 


0 

0 

1 

0 


0 

—r6{t) 

0 

1 


(6.2) 


Then  g2(f)  represents  a rotation  of  the  frame  T2  about  the  ar-axis  of  the  frame  Tx, 


while  gi(f)  represents  the  translation  of  the  frame  T\  along  the  negative  y-axis  of 

=3 

the  frame  Tq.  Thus,  the  space  E is  rotating  with  respect  to  the  space  E3,  while 

— 3 

E is  translating  with  respect  to  E3.  The  composition  gi(t)g2(t)  then  results  in  a 

3 

combined  rotation  and  translation  of  E with  respect  to  E3.  This  motion  can  be 


interpreted  as  the  rolling  cylinder  encountered  in  Section  5.2. 


6.2  Composition  Interpreted  as  a Change  in  Frames 

Let  g(t)  be  a mapping  of  the  frame  T\  to  the  frame  J-2  as  a function  of  time.  Let  h 
be  a fixed  mapping  of  the  frame  T2  to  the  frame  Tj,-  The  composition  g(f)h  is  then 
given  by  the  mapping 
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Define  the  frame  T\  to  be  at  rest  with  respect  to  a space  E3,  and  Ti-,  Tz  to  be  at 

— 3 =3 

rest  with  respect  to  E , E respectively.  Since  T\  and  Tz  are  related  by  the  fixed 

— 3 =3 

mapping  h,  it  is  seen  that  E and  E are  at  rest  with  respect  to  each  other.  If  the 
mappings  are  interpreted  as  the  motion  of  a body  in  space  and  time,  then 

g(f)  and  g(f)h 

are  seen  to  represent  the  same  motion  of  the  body  in  space  and  time,  but  with  a 
change  in  the  frame  at  rest  with  respect  to  the  moving  space  that  is  given  by 

T2  T3. 

This  situation  was  initially  introduced  via  the  mapping  i?h  acting  on  the  motion  g (t) 
as  described  in  Section  5.2. 

In  a similar  fashion,  consider  redefining  h to  be  a fixed  mapping  of  the  frame 
To  to  the  frame  T\.  Let  g (t)  remain  a mapping  of  the  frame  T\  to  the  frame  T2  as 
a function  of  time.  The  composition  hg(f)  is  then  given  by  the  mapping 

J- 0 1 * J- 1 I > T2. 

Define  the  frame  To  to  be  at  rest  with  respect  to  a space  E3,  and  T\,  T2  to  be  at 

2 — 3 

rest  with  respect  to  E , E respectively.  Since  To  and  T\  are  related  by  the  fixed 
mapping  h,  it  is  seen  that  E3  and  E are  at  rest  with  respect  to  each  other.  If  the 
mappings  are  interpreted  as  the  motion  of  a body  in  space  and  time,  then 

g(t)  and  hg(t) 

aie  seen  to  represent  the  same  motion  of  the  body,  but  with  a change  in  the  frame 
at  rest  with  respect  to  the  fixed  space  that  is  given  by 

To^Tl 
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motion 

fixed  frame  T\ 

moving  frame  T2 

g(*) 

no  change 

no  change 

g(0h 

no  change 

change  by  h to  T-$ 

hg  (*) 

change  by  h-1  to 

no  change 

Table  6.1.  Interpretation  of  Changing  Frames  via  Composition 

This  situation  was  initially  introduced  via  the  mapping  L h acting  on  the  motion  g (t) 
as  described  in  Section  5.3. 

The  effect  of  the  operation  of  composition  interpreted  as  a change  in  frames  is 
summarised  in  Table  6.2.  It  is  noted  that  the  motion  of  the  body  remains  invariant 
in  this  description. 

6.3  The  Effect  on  the  Fixed  and  Moving  Generalised  Axodes 

The  effect  of  a change  in  frames  on  the  fixed  and  moving  generalised  axodes 
is  now  investigated.  Let  g(t)  be  a mapping  of  the  frame  T\  to  the  frame  as  a 
function  of  time.  Interpreting  g (t)  as  the  motion  of  a body  through  space  and  time 
results  in  the  fixed  and  moving  generalised  axodes  of  the  motion  being  given  by 

x(0  = g(0g_1(<) 

and 

respectively. 

The  effect  of  a change  in  the  fixed  frame  on  the  fixed  and  moving  generalised 
axodes  is  analysed  first.  Let  h be  a mapping  of  the  frame  T2  to  the  frame  Tz.  Then 
it  has  been  seen  that  the  mapping  g(*)h  corresponds  to  the  same  motion  of  the  body, 
but  with  a change  in  the  moving  frame  that  is  given  by 
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Ti  A jr3. 


The  fixed  and  moving  generalised  axodes  of  the  motion  are  then  given  by 


“W«)b]-  = g(<)hh-'g-'(() 
= g(0g_1(0 

= m 


[g(0h]-x 


<*[g(0h] 

dt 


h-'g-^OgCOh 

h-^g-^OgWJh 

h"1X(0h 


respectively. 

Thus,  a change  in  the  moving  frame  leaves  the  fixed  generalised  axode  invariant 
and  affects  only  the  moving  generalised  axode.  This  is  consistent  since  the  fixed 
generalised  axode  is  composed  of  components  given  in  terms  of  the  fixed  frame, 
which  remains  unchanged.  In  contrast,  the  moving  generalised  axode  is  composed  of 
components  given  in  terms  of  the  moving  frame  that  is  affected  by  the  mapping  h. 

In  a similar  fashion,  the  effect  of  a change  in  the  moving  frame  on  the  fixed  and 
moving  generalised  axodes  is  analysed.  Redefine  h to  be  a mapping  of  the  frame  Tq 
to  the  frame  T\.  Then  the  mapping  hg(<)  corresponds  to  the  same  motion  of  the 
body,  but  with  a change  in  the  fixed  frame  that  is  given  by 

fo  ^ Tx. 
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The  fixed  and  moving  generalised  axodes  of  the  motion  are  then  given  by 


and 


^pWr*  = hg(()g-(()h-‘ 

= h(g(()g-'(i)h-' 

= hX^h-1 


lhg«r‘M  = g-Wh-hg« 
= g -\mt) 

= X(<) 


respectively. 

Thus,  a change  in  the  fixed  frame  leaves  the  moving  generalised  axode  invari- 
ant and  affects  only  the  fixed  generalised  axode.  This  is  again  consistent  since  the 
moving  generalised  axode  is  composed  of  components  given  in  terms  of  the  moving 
frame,  which  remains  unchanged.  In  contrast,  the  fixed  generalised  is  composed  of 
components  given  in  terms  of  the  fixed  frame  that  is  affected  by  the  mapping  h-1. 

The  effect  of  a change  in  frames  on  the  fixed  and  moving  generalised  axodes 
is  summarised  in  Table  6.3.  It  should  again  be  noted  that  the  motion  of  the  body 
remains  invariant  in  this  description. 

M The  Physical  Implications  on  the  Fixed  Generalised  Axode 


The  physical  interpretation  of  the  change  in  the  fixed  generalised  axode,  due  to 
a change  in  the  fixed  frame,  is  now  explored.  One  may  recall,  from  Section  5.2,  that 
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motion 

fixed  frame  T\ 

moving  frame  Ti 

FGA 

MGA 

g(<) 

no  change 

no  change 

X(<) 

X(t) 

s(0h 

no  change 

change  by  h to  Tz 

X(<) 

h-1X(f)h 

hg(0 

change  by  h-1  to  Tq 

no  change 

hX(f)h~1 

X(t) 

Table  6.2.  Effect  of  a Change  in  Frames  on  the  Generalised  Axodes 

X(t)  can  be  written  as  a linear  combination  of  the  basis  tangent  vectors  of  Te G given 
by  ux,u)y,<joz,vx,vy,vz.  Thus, 

X(f)  = (SXU>X  + SyUJy  + SZUZ  -f  ^OX^x  “i”  ^oyVy  + SozVz)(t) 

where  Sx,  Sy , Sz,  Sox,  Soy , Soz  are  scalar  functions  of  time.  Let  h be  a fixed  mapping. 
Then,  from  Table  6.3,  the  change  in  the  fixed  generalised  axode  is  given  by 


hX(2)h  1 = h(5xa;a:  + Syuy  + Szuz  + Soxvx  + Soyvy  + Sozvz)(t)h  1. 


From  this  equation,  it  is  seen  that  the  change  can  be  determined  by  analysing  the 
effect  on  the  basis  tangent  vectors.  Recalling  the  notation 

sx 

Sy 

.S'lt 

and 


[X(t)]i  = 


it  is  seen  that  the  components  of  hX(f)h_1  are  given  by 


[hXfOh-1]!  = S^IhuOi-1]!  + SyWihuyh-1^  + S.WIhw.h-1]! 

+5OI(0[hurh-1]1  + <S'o»(0[hwyh-1]1  + ^(^[h^h'1]!  (6.3) 
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and 


[hX^h-1^  = 5,(0[hu;xh-1]o  + 5J,(0[hu;!/h-1]o  + 52(0[ha;,h-1]o 

+S'ox(*)[hi>Ih-1]o  + 5oy(i)[ht;!/h_1]o  + S0,(f)[ht;,h-1]o.  (6.4) 


Let  the  fixed  mapping  h be  denoted  by 


/ill 

hi2 

/il3 

X 

Zi  2 1 

h22 

/i23 

y 

Zi"  31 

h32 

h33 

z 

0 

0 

0 

1 

First,  consider  the  effect  on  the  basis  tangent  vectors  uox,u>y,uz.  One  finds 


hcuxh  1 


0 —^31  /*21 

/l3i  0 —/in 

— /i2i  h\\  0 

0 0 0 


yh31  - zh2i 
— xh3i  + zh\\ 
xh2\  — yh\\ 
0 


Comparing  the  above  matrix  with  the  definitions  of  u>x,ujy,uz,vx,Vy,vz  summarised 
in  5.1,  it  is  seen  that  ha;h_1  has  components  given  by 


and 


[hwxh  a]i 


^11 

h2\ 

h3i 


Also, 


[hwxh  1]0 


X 

/ill 

y 

X 

/i  2 1 

z 

h3i 

hu^h  1 


0 —h32  h22 

h32  0 — h\2 

—h22  h\2  0 

0 0 0 


yh  32  — zh22 

— xh32  + zh\2 
xh-22  — yhu 
0 


Thus,  \iuiyh.  1 has  components  given  by 
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and 


[hwyh  ^ 


^12 
h 22 

^32 


Also, 


[/icjyh  1]0 


X 

1 

to 

= 

y 

X 

^22 

z 

^32 

' 0 

~h  33 

h23 

J/^33 

- zh23 

hcj,  h 1 = 

^33 

0 

— h\3 

—xhtt  T zh\3 

~h  23 

hi3 

0 

xh2  3 

- yhi3 

0 

0 

0 

0 

Thus,  hw2h  1 has  components  given  by 


[hcu2h  a]i 


hi3 
h"23 
h 33 


and 


[hu>2h  J]0 


a; 

hi3 

= 

y 

X 

h 23 

z 

^33 

Next,  consider  the  effect  on  the  basis  tangent  vectors  vx,vy,vz.  One  finds 


' 0 

0 

0 

hn 

1 

0 

0 

0 

h2i 

0 

0 

0 

h-31 

. 0 

0 

0 

0 

Thus,  huxh  1 has  components  given  by 


[huxh  J]j 


0 

0 

0 


and 
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Also, 


[h^h  1]0 


hn 

^21 

^31 


huyh  1 


0 

0 

0 

to 

0 

0 

0 

^22 

0 

0 

0 

^32 

0 

0 

0 

0 

Thus,  hvyh  1 has  components  given  by 


and 


Also, 


[hvyh  x]i 


0 

0 

0 


[huwh  x]0 


hu 

h.22 

h 32 


lit^h  1 


0 

0 

0 

hi3 

0 

0 

0 

^23 

0 

0 

0 

^33 

0 

0 

0 

0 

Thus,  hi^h  1 has  components  given  by 


and 


[huzh  x]a 


0 

0 

0 


[h^h  x]0  = 


^13 

^23 

^33 


Substituting  the  last  six  sets  of  components  into  equations  6.3  and  6.4  yields 
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[hX(f)h-1]1 


and 


/ill 

h\2 

hi3 

— 

/l21 

Sx(t)  + 

^22 

Sy(t)  + 

/*23 

/*31 

fl32 

/*33  . 

/ill 

hu 

hl3 

Sx 

= 

h2\ 

/*22 

^23 

Sy 

^31 

/*32 

/*33  . 

. s* 

t 

S.{t) 


[hx^h-'b 


x 

y 


/in 

h 21 
^31 


*Sx(i)  + 


X 

y 


h\2 

h22 

hz2 


Sy(t)  + 


x 

y 


U 

L-  J 

J 

L J 

/ill 

h 12 

hi3 

+ 

/l21 

Sox(t)  + 

h22 

Soy(t)  + 

/*23 

sOj,(0 

h.31 

h.32 

/I33 

X 

/ill  /*12 

hl3 

' sx  ' 

CO 

<N 

rH 

1 

y 

X 

/l21  h22 

h 23 

Sy 

+ 

/l21  /*22  /*23 

z 

/l3 1 /*32 

/*33 

. S*  . 

t 

^31  /*32  /*33 

hi3 

h23 

^33 


S.(t) 


Joy 


Let 


roi  = 


X 

y 


represent  the  components  of  the  position  of  the  frame  T\  in  terms  of  the  frame  ?Q. 
Then 


[hX^h-1]!  = [h]3x3[X(<)]i 

[hX(f)h  ]0  = roi  x [h]3x3pC(<)]i  + [h]3X3[X(f)]o. 

The  physical  interpretation  of  these  components  is  as  follows:  Since  [X(f)]j 
represents  the  components  of  the  angular  velocity  of  the  body  in  terms  of  the  frame 
T\,  then 
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[hX^h-1]!  = [h]3X3[A-(<)]i 


represents  the  components  of  the  angular  velocity  of  the  body  in  terms  of  the  frame 
T0.  This  conclusion  is  evident  upon  recalling  the  relationship  between  the  compo- 
nents of  a vector  expressed  in  two  different  frames  that  was  demonstrated  in  Section 
3.1. 

The  last  three  components  are  understood  by  recalling  that 


[X(/)]o  — r12(f)  X [X(f)]i  + ri2(f) 

represents  the  translational  velocity  of  the  point  in  the  body  that  is  co-incident  with 
the  frame  T\.  Then 


[hX(i)h-']„  = 


1*01  x [h]3x3[X(f )]i  -f  [h]3x3[X(^)]0 

roi  x [h]3x3[X(2)]!  + [h]3X3(ri2(2)  x [X(t)]i  + 1*12(2)) 

1*01  X [h]3x3[X(2)]!  + ([h]3x3ri2(2))  x ([h]3x3[X(2)]!)  + [h]3x3r*i2(2) 
(1*01  + [h]3x3l*12(2))  X ([h]3x3[X(f)]j  -f  [h]3x3i*i2(2)). 


Define 


1*02(2)  — I*oi  + [h]3x3l*i2(2) 


to  be  the  components  of  the  position  of  the  frame  Ti  in  terms  of  the  frame  T0.  Since 
1*01  is  fixed  in  time, 


1*02(2)  = [h]3x3ri2(2). 


Thus, 
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[hX(i)h  1]0  = r02(<)  x [h]3x3[X(i)]i  + rO2(0 
= r oa(i)  x [hX(f)h-1]i  + rO2(0- 

Hence,  [hX(t)h_1]o  represents  the  translational  velocity  of  the  point  in  the  body  that 
is  co-incident  with  the  frame  Tq. 

In  summary,  hX(f)h-1  represents  the  generalised  axode  of  the  motion  of  the 
body  with  respect  to  the  frame  Tq.  That  is,  the  components  of  the  generalised  axode 
are  given  in  terms  of  the  frame  J-Q. 

6.5  The  Physical  Implications  on  the  Moving  Generalised  Axode 

The  physical  interpretation  of  the  change  in  the  moving  generalised  axode,  due 
to  a change  in  the  moving  frame,  is  now  explored.  It  is  recalled,  from  Section  5.3, 
that  X(f)  can  be  written  as 

X(t)  = (SXUX  + SyUy  + SZU)Z  + SOXVX  + SoyVy  + SOZVZ)(t) 

where  Sx,  Sy,  Sz,  Sox,  Soy,  Soz  are  scalar  functions  of  time.  Let  h be  a fixed  mapping. 
Then  from  Table  6.3,  the  change  in  the  moving  generalised  axode  is  given  by 

h 1X(<)h  = h l(Sxhjx SvUy  + Szuz  + Soxvx  + SoyVy  + Sozvx)\i(t). 

From  this  equation,  it  is  seen  that  the  change  can  again  be  determined  by  analysing 
the  effect  on  the  basis  tangent  vectors.  Recalling  the  notation 

[x(0]i  = 


and 
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it  is  seen  that  the  components  of  h 1X(t)h  are  given  by 


[h^X^hh  = + ^(<)[h-1W2h]i 

+S'or(t)[h_1nrh]1  -fi  5,oJ/(^)[h~1^yh]1  + 50,(<)[h-1«,h]i  (6.5) 


and 


[h-'X^hJo  = 5’I(i)[h-1u;,h]o  + S,lf(<)[h-1wyh]o  + 5,,(0[h-1w,h]o 

+5'ox(f)[h-1nxh]0  + [S0„(t)h-1i;yh]o  + So*(f)[h_1u2h]0.  (6.6) 


First,  consider  the  effect  on  the  basis  tangent  vectors  u>x,uy,ujz.  One  finds 


h 1o;xh 


0 

~h\3 

h\2 

yh  31  — zh2i 

h\3 

0 

—hn 

yh32  — zh22 

—hi2 

h\\ 

0 

yh33  — yh23 

0 

0 

0 

0 

Comparing  the  above  matrix  with  the  definitions  of  /jjx,u)y,u>z,vx,Vy,vz  summarised 
in  5.1,  it  is  seen  that  h-1tuh  has  components  given  by 


and 


[h  1o>xh]1 


fin 

hu 

hi3 


yh31  - zhi\ 

yh 32  ~ zh-22 

yh33  - yh23 

Also, 


[h  1u;xh]0  = 
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h l0Jyh.  = 


0 

h?3 
— /i22 
0 


— ^23 

h22 

— xh3i  -T  zh\i 

0 

— /l2l 

—xh32  + zh\2 

h2\ 

0 

—xh33  + zh\3 

0 

0 

0 

Thus,  h 1wyh  has  components  given  by 

^21 
/*22 
^23 


[h  ^yh]!  = 


and 


Also, 


[h  ^yhjo  = 


—xh  3i  + zh\\ 
—xhz2  + zh\2 
-xh33  + zhl3 


i 

o 

—h33 

hz2 

xh2\  — yh\i 

^33 

0 

—h3\ 

xh22  - yh12 

—h32 

hz\ 

0 

xh23  — yh13 

0 

0 

0 

0 

Thus,  h luzh.  has  components  given  by 


[h  1w,h]i 


^31 

^32 

^33 


and 


[h  1w2h]0  = 


xh2i  - yhn 
xh  22  — yh\2 
xh23  — yhi3 


Next,  consider  the  effect  on  the  basis  tangent  vectors  vx,  vy,  vz.  One  finds 


h 


' 0 

0 

0 

/in 

0 

0 

0 

h\2 

0 

0 

0 

h\3 

. 0 

0 

0 

0 

Thus,  h has  components  given  by 


[h  1uIh]i 


0 

0 

0 


and 


Also, 


[h  1uIh]0  = 


/in 

h 12 
h\z 


0 

0 

0 

h2\ 

0 

0 

0 

h 22 

0 

0 

0 

^23 

. 0 

0 

0 

0 

Thus,  h has  components  given  by 


[h  ^hji  = 


0 

0 

0 


and 


Also, 


[h  \h]0  = 


/l21 

^22 

^23 


h 1nih 


' 0 0 0 A3i 

0 0 0 /132 

0 0 0 /133 

.0  0 0 0 


Thus,  h 1n2h  has  components  given  by 


[h  1u2h]i 


0 ' 
0 
0 


and 
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[h  xu2h]o  = 


^32 
h 33 


Substituting  the  last  six  sets  of  components  into  equations  6.5  and  6.6  yields 


[h^X^hh  = 


and 


[h~lX(t)h]0  = 


hn 

121 

^31 

= 

h\2 

Sx(t)  + 

h22 

Sy(t)  + 

^32 

h\3 

^23 

h33 

hn 

h2i 

^31 

' sx 

= 

h\2 

h22 

^32 

Sy 

hi3 

h23 

h33 

sz 

t 

S,(t) 


Let 


yh3i  - zh2 1 
yh32  — zh22 

yh 33  - yh23 


Sx(t)  4- 


—xh3\  + zh\\ 
—xh32  + zh\2 
—xh33  + zh\3 


+ 


hn 

h2\ 

^31 

hi2 

Sox(t ) + 

h2  2 

Soy(t)  + 

h32 

h\3 

h23 

h.33 

Sy(t)  + 


S0z(t) 


xh2\  — yhu 
xh22  — yh\2 
xh-23  ~ yh\3 


hn 

h\2 

h\3 


(zSy(t)~  ySz(t))  + 


h2\ 

h22 

h23 


(xSz(t)  - zSx(t )) 


^31 

( ySx(t ) - xSy(t))  + 

hn 

h2\ 

^31 

s ox 

+ 

^32 

h\2 

h22 

h-32 

Soy 

h33 

h\3 

h23 

h-33  _ 

Soz 

-11 

h2\ 

h-31 

12 

h22 

S32 

13 

h23 

S33 

sx 

x 

\ r 

Sy 

X 

y 

+ 

. \ 

. . 

t 

z 

) . 

h\i  h2 1 h3i 

hi  2 h22  h32 
hi3  h23  h33 


S,(t) 


Joy 


X 

y 

Z 


r23  = 
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represent  the  components  of  the  position  of  the  frame  J- 3 in  terms  of  the  frame  J- 2. 
Then 


[h"1X(*)h]1  = [h-^axslX^)]! 

[h  1X(<)h]0  = [h  1]3x3([X(f)]j  x r23)  + [h  a]3x3[X(<)]o. 

The  physical  interpretation  of  these  components  is  as  follows:  Since  h-1X(f)h 
represents  the  components  of  the  angular  velocity  of  the  body  in  terms  of  the  frame 
Tv,  then 


[h-1X(f)h]x  = [h_1]3x3[X(i)]i 

represents  the  components  of  the  angular  velocity  of  the  body  in  terms  of  the  frame 

Tz. 

The  last  three  components  are  understood  by  recalling  that 

[X(f)]0  = [g  1{t)]3x3^u(t)  (6.7) 

represents  the  translational  velocity  of  the  point  in  the  body  that  is  co-incident  with 
the  frame  JF2.  Then 


[h-1X(*)h]0 


[h  ]3x3([X(^)]x  x r23)  + [h  1]3X3[X(^)]o 
[h  ]3x3([X(^)]j  x r23  + [X(f)]0). 


Define 


(6.8) 


r13(f)  — Tl2(0  + [g(f)]3x3r23 
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to  be  the  components  of  the  position  of  the  frame  Tz  given  in  terms  of  the  frame  T\. 
Since  r23  is  fixed  in  time, 


1*13(0  — + [g(0]3x3l*23-  (6-9) 

Also,  it  can  be  checked  from  (5.15)  that  the  moving  generalised  axode  has  its  first 
three  directional  components  encoded  in  matrix  form  as 


Thus, 


[g  1(0g(0]ax3 


_0  -Sz  S_y  ' 
S ± _0  -5, 

— Sy  SX  0 


0 -3,(0 

SJt)  1 

X 

[g  1(0g(0]sx3r23  = 

S,(t ) 0 

-5,(0 

y 

.-5,(0  5,(0 

0 

t 

z 

= fx(0]i  X 1*23-  (6.10) 

Hence  substituting  (6.9)  and  (6.10)  into  (6.8)  yields 


[h  X(0h]O  = [h  1]3x3([g  1(0g(0]3x3l*23  + [g  1 (0]3x3l*12(0) 

= ][g  1(0]3x3([g(0]3x3l*23  + 1*12(0) 

= 0[g  1(0]3X3I*13(0- 

Hence  [^-1X(0h]o  represents  the  translational  velocity  of  the  point  in  the  body  that 
is  co-incident  with  the  frame  Tz- 

In  summary,  h~1X( Oh  represents  the  generalised  axode  of  the  motion  of  the 
body  with  respect  to  the  frame  That  is,  the  components  of  the  generalised  axode 
are  given  in  terms  of  the  frame  JF3. 
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6.6  The  Relationship  Between  the  Generalised  Axodes 

It  has  just  been  shown  that  the  fixed  and  moving  generalised  axodes  can  always 
be  interpreted  in  an  invariant  manner.  If  X(t)  is  a generalised  axode  with  respect 
to  a frame  J7,  then  the  first  three  components  of  X(t)  always  represent  the  angular 
velocity  of  the  body  in  terms  of  the  frame  T,  and  the  last  three  components  of  X(t) 
always  represent  the  translational  velocity  of  the  point  in  the  body  co-incident  with 
the  frame  JF,  in  terms  of  the  frame  T . 

With  this  invariant  interpretation,  it  is  now  possible  to  describe  the  relationship 
between  the  expressions  for  an  axode  in  different  frames.  If  g (t)  represents  the  motion 
of  a body  with  respect  to  a fixed  frame  T and  a moving  frame  T ',  then  the  fixed  and 
moving  generalised  axodes  have  the  form 

x(0  = g(0g_1(0 

and 

m = g ~\tm 

respectively.  These  two  generalised  axodes  are  special  in  that  they  are  expressed  in 
terms  of  the  fixed  and  moving  frames  of  the  motion  respectively.  Indeed,  they  can 
also  be  seen  to  be  related  via  the  motion  g(t)  since 

x(<)  = g(<)g_1(0 

= [g(0g_1(0]g(0g_1(0 
= g(0[g_1(0g(0]g_1(0 


Conversely, 
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x(t)  = g-'WWg  (t). 


Interpreted  as  a change  in  the  fixed  frame  given  by 

-7“  'T~ 

J i ^ 2) 


it  is  seen  that  the  components  of  the  fixed  generalised  axode  are  transformed  into 
the  components  of  the  moving  generalised  axode.  This  is  exactly  what  one  would 
expect,  as  g (t)  is  defined  as  mapping  the  fixed  framing  to  the  moving  frame. 
Conversely,  interpreted  as  a change  in  the  moving  frame  by 


it  is  seen  that  the  components  of  the  moving  generalised  axode  are  transformed 
into  the  components  of  the  fixed  generalised  axode.  Thus,  it  is  seen  that  these  two 
generalised  axodes  represent  the  same  geometric  entity  of  the  motion  the  body,  and 
are  just  expressed  in  terms  of  different  frames. 

One  can  generalise  this  concept  and  derive  an  expression  for  the  relationship  be- 
tween the  co-ordinate  expression  of  a generalised  axode  expressed  in  different  frames. 
If  Y G TeG  is  an  arbitrary  tangent  vector  and  h £ G is  an  arbitrary  element,  then 
define  the  mapping 


adh  : TeG  — > TeG 

such  that 


X i— ► hXh-1. 

This  mapping  will  henceforth  be  called  the  adjoint  mapping.  It  provides  the  rule  for 
the  change  in  co-ordinates  of  generalised  axodes  due  to  a change  in  frame. 
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An  explicit  representation  for  the  adjoint  mapping  is  now  determined.  Let  h 6 G 
and  X(f)  be  given  in  terms  of  T\  by 


Then 


X(()  = 


and 


h ii  h 12  h i3 

‘ S*  ' 

[adhX(/)]i  = 

h2\  h22  h23 

Sv 

^3i  h32  h33 

s. 

[adhX(t)]  o 


X 

( 

/ill 

= 

y 

X 

h2\ 

z 

\ 

h-31 

0 

—z 

y 

— 

z 

0 

— X 

-y 

X 

0 

h\2  h\3 

' Sx  ' 

\ 

/in  h\2  h\3 

h22  h23 

Sy 

+ 

h2\  h22  h23 

^32  h33 

sz 

t) 

^3i  h32  h33 

/in  h\2  /ii3 

Sx 

/in  h\2  h\3 

r 

h 21  h22  h2  3 

Sy 

+ 

h2\  h22  h23 

^3i  h32  h33 

. . 

t 

h3\  h32  h33 

t 


J t 


Thus, 


adhX(t)  = 


/in 

/i  1 2 

h2i 

h22 

h3\ 

h-32 

yh  31  — zh2\ 

yh32  — zh22 

—xh3\  -(-  zhn 

—xh32  + zh\2 

xh21  - yhn 

xh  22  — yh\2 

h\3 

0 

0 

0 ‘ 

sx 

^23 

0 

0 

0 

Sy 

h33 

0 

0 

0 

sz 

yh33  — zh23 

/ill 

h\2 

hi3 

c 

u OX 

~xh33  + 3r/ii3 

/121 

h22 

h-23 

c 

°oy 

xh23  — yh\3 

S3\ 

h32 

h-33  . 

C 

_ L->OZ  J 

(6.11) 
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The  above  6x6  matrix,  acting  on  the  components  of  the  generalised  axode,  is  com- 
monly referred  to  as  the  screw  transformation  matrix  in  the  robotic  literature.  It  is 
clearly  a bijection  as  the  determinant  is  equal  to  one. 


CHAPTER  7 

THE  EXISTENCE  OF  A SEMI-RIEMANNIAN  METRIC 


A semi-Riemannian  metric  on  a differentiable  manifold  M is  the  assignment  of 
a symmetric  non-degenerate  bilinear  form  to  the  vector  space  TPM , for  every  p £ M. 
This  form  at  the  point  p will  be  denoted  by  < , >p.  The  task  of  this  chapter  is  to 
define  an  semi-Riemannian  metric  on  the  Euclidean  group  G. 

First  consider  Te G,  the  tangent  space  at  the  identity  element  of  the  Euclidean 
group.  Let  the  co-ordinates  of  X,  Y € TeG  be  given  in  terms  of  a frame  T\  such  that 


X = 


' Aa  ' 

' Yi  ■ 

y2 

y2 

x3 

and  Y = 

y3 

X01 

Y01 

X02 

Y02 

. *03  . 

. Yq3  . 

Consider  a symmetric  non- degenerate  bilinear  mapping 

< , >e:  TeG  x Te G — ► R 

defined  by 


< X,  Y >e—  YiVoi  + X2Y02  + X3Y33  + Y1X01  + Y2X02  + Y3X03. 

This  is  recognised  to  be  the  well  known  reciprocal  product  encountered  in  screw  the- 
ory. To  be  useful  and  physically  meaningful,  this  bilinear  mapping  must  be  invariant 
with  respect  to  any  change  in  frame.  That  is,  if  T2  is  another  frame  such  that 

Xx  ^ X 2, 
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then  the  co-ordinates  of  X and  Y,  with  respect  to  Ti  are  given  by 

ad^X  and  ad^Y 

where  ad h is  the  6x6  matrix  given  in  (6.11).  Invariance  of  the  metric  implies  that 

< adhX,  adhY  >e=<  X,Y  >e  . 

In  proving  this  property,  which  shall  henceforth  be  called  ad-invariance,  let  -<  , X 
denote  the  standard  inner  product  of  vectors  in  R3.  This  yields  the  notation 

< X,  Y >e=^  [X]i,  [Y]oi  > — I — < [Y]i,  [X]oi  >~  . 

Two  properties  concerning  this  inner  product  are  needed.  The  first  is  the  fact  that 
-<  , >-  is  invariant  with  respect  to  ortho-normal  matrices.  That  is,  if  u,v  G R3  and 
[h]3x3  is  an  ortho-normal  matrix,  then 

-<  [h]3X3U,  [h]3x3v  X=X  u,  V y . (7.1) 

The  second  property  is  the  fact  that 


-<  U,  V X W >-=-<  V , W X U >-=-<  W,U  X V >- 


(7.2) 


for  u,v,w  6 R3.  Geometrically,  this  quantity  represents  the  volume  of  the  paral- 
lelepiped spanned  by  the  three  vectors  and  is  equivalently  given  by 


-X  u,  v x w >-= 


Ml 

U2 

U3 

Vl 

V2 

V3 

wl 

W2 

W3 

Proceeding  with  the  proof  of  ad-invariance, 
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< ao?hX,  adfrY  >e 

= ^[hUX^rxthUtn  + lh]  3x3Y0i  x- 

+ -<  [h]3x3[Y]!,r  x [h]  3x3  ][X]i  + [h]  3x3X01  y 

= -<  [h]3x3[X]i,  [h]3x3Yoi  > — I < [h]3X3[Y]i,  [h]3x3X0i  X- 

H < [h]3x3[X]i, r x [h]3x3][Y]i  > — f -X  [h]  3x3[Y]i),r  x [h]3x3][X]i  X 
= ~<  [X]i,  [Y]oi  X + -<  [Y]i,  [X]oi  X- 

+ ^ r,  ([h]3x3[Y]a)  x ([h]3x3[X]x)  y + ^r,([h]  3x3 [X]  1 ) x ([h]3x3[Y]!)  y 
= [X]1;  [Y]01  y + -<  [Y]x,  [X]0i  X- 

Thus,  < , >e  is  ad-invariant  and  therefore  invariant  with  respect  to  a change  in 
frame. 

The  physical  interpretation  of  the  action  of  this  bilinear  mapping  on  a general- 
ized axode  is  revealed  in  the  following  manner:  Since  < , >e  is  ad-invariant,  one  can 
examine  the  mapping  in  the  frame  of  one’s  choice.  Let 

9 ■ 

represent  the  motion  of  a body.  Then  the  fixed  generalized  axode  X(t)  has  rotational 
components  given  by  [X]i(f)  and  translational  components  given  by  ri2(f)  x [X]!(f)-|- 
i*i2(0-  Thus 


< X,  X >e  (t)  = 2 -x  [X]1;  ri2  x [X]i  + r12  >-  (t) 

= 2 “<  [X]i,r12  x [X]x  X-  (t)  + 2([X]1}  r12  x-  (<) 
= 2 -X  [X]i,  r12  X-  (f) 
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The  quantity  X [X]i,ri2  X ( t ) is  a measure  of  the  extent  to  which  the  body  is 
experiencing  combined  rotational  and  translational  motion.  The  quantity 


P = 


A [X]i,  1*12  >- 

^[XhJX]^ 


is  referred  to  as  the  pitch  in  the  robotic  literature.  It  has  units  of  length  per  radians. 
In  general,  at  any  instant  in  time,  there  exists  a line  of  points  in  the  body  which 
experience  only  translational  velocity  along  that  line.  The  magnitude  of  this  velocity 
is  given  by  the  pitch. 

As  a simple  example  of  the  bilinear  form  < , > acting  on  a generalized  axode, 
consider  again  the  fixed  generalized  axode  of  the  rolling  cylinder.  Here 


Then  trivially 


x(<)  = 


1 

0 

0 

0 


m 


< X,X  >e  (t)  = 0. 


This  indicates  that  the  cylinder  is  always  experiencing  instantaneous  rotational  mo- 
tion about  a line.  That  line  is,  of  course,  the  point  of  contact  on  the  imaginary  plane 
along  which  it  can  be  considered  to  be  rolling. 


CHAPTER  8 

APPLICATIONS  TO  ROBOTICS 


8.1  The  Group  Structure  in  Robotics 

A robot  manipulator  can  be  considered  to  be  an  open  chain  of  rigid  bodies  or 
links  connected  together  by  joints  which  define  the  relative  freedoms  of  motion  of  a 
body  with  respect  to  its  adjacent  bodies.  Points  at  rest  with  respect  to  the  body 
at  one  end  of  the  chain  constitute  a three  dimensional  Euclidean  space.  This  will 
henceforth  be  denoted  by  E3  and  called  the  base  space.  Points  at  rest  with  respect  to 
the  body  at  the  other  end  of  the  chain  constitute  another  three  dimensional  Euclidean 
space.  This  will  henceforth  be  denoted  by  E3  and  called  the  end  effector  space. 

Of  interest  is  the  motion  of  E with  respect  to  E3,  enabled  by  the  joints  defining 
the  relative  freedoms  of  motion  of  the  links.  One  can  represent  this  motion  by  the 
relative  position  and  orientation  of  two  frames,  one  at  rest  with  respect  to  the  base 
space,  the  other  at  rest  with  respect  to  the  end  effector  space.  The  frame  at  rest  with 
respect  to  the  base  space  will  henceforth  be  denoted  by  T and  called  the  fixed  frame. 
The  frame  at  rest  with  respect  to  the  end  effector  space  will  henceforth  be  denoted 
by  T and  called  the  moving  frame. 

The  geometric  workspace  of  the  manipulator  is  defined  to  be  the  set  of  all  po- 
sitions  and  orientations  of  E with  respect  to  E3  induced  by  the  specification  of  the 
fiames  J-  and  T . This  is  some  subset,  determined  by  the  geometric  configuration  of 
the  manipulator,  of  all  possible  positions  and  orientations  of  E with  respect  to  E3. 
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At  any  instant,  the  mapping  which  takes  the  fixed  frame  to  the  moving  frame  will 
henceforth  be  denoted  by 

S '■ 

where  g is  the  matrix  given  by  (3.2)  in  terms  of  the  Euler  parameters. 


8.2  The  Concept  of  Volume 


The  task  of  this  chapter  is  to  define  a measure  with  which  to  quantify  the 
geometric  workspace  of  the  manipulator  by  assigning  a numerical  value  describing, 
in  some  sense,  the  volume  of  the  subset  of  all  possible  positions  and  orientations 
of  T with  respect  to  T . To  be  useful,  this  volume  must  be  invariant  with  respect 
to  the  choice  of  the  fixed  frame  and  the  moving  frame  for  the  base  space  and  end 
effector  space  respectively.  The  theory  and  techniques  must  also  be  applicable  to 
manipulators  of  arbitrary  design.  The  resulting  numerical  value  will  henceforth  be 
called  the  motion  capability  of  the  manipulator  as  it  represents  the  capability  of  the 
end  effector,  or  last  link,  to  rotate  and  translate  with  respect  to  the  base,  or  first 
link,  of  the  manipulator. 

The  technique  that  is  used  in  measuring  a subset  of  the  Euclidean  group  is  similar 
to  that  of  calculating  the  area  of  a region  in  R2,  which  is  achieved  by  integrating  the 
area  element  dV  = dxdy  over  the  region  of  concern.  It  is  recalled  that  R2  is  a trivial 
example  of  a two  dimensional  differentiable  manifold.  The  area  of  the  region  of  R2 
shown  in  Figure  8.1  is  given  by 


-L 


dA. 


The  area  element  is  dA  = dxdy , and  the  integral  yields 

ry/a2—x2 


ra  rwaz—xz 

A = / / dxdy  — 

Jx=—a Jy— 0 


7 ra 


105 


y 


Figure  8.1.  Semicircular  Region  in  the  Plane 


Using  polar  co-ordinates,  one  can  reparameterize  R2  in  terms  of  the  variables 
(r,  9)  by  the  equations 


x = r cos  6 


y = r sin  8, 

for  r > 0 and  6 € [0,27t).  The  area  element  then  changes  to  dA  = rdrdO,  and 


= r r 

Jr= 0 Je= 0 


r drd6  = 


■Ka“ 


This  simple  result  is  intended  to  illustrate  the  geometric  interpretation  of  the 
area  element.  The  invariant  nature  of  the  area  element  with  respect  to  the  param- 
eterization is  noted.  The  relationship  between  the  area  element  dxdy  in  cartesian 
co-ordinates  and  the  area  element  r drd9  in  polar  co-ordinates  can  be  examined  by 
first  returning  to  cartesian  co-ordinates. 

The  curves  formed  by  fixing  each  co-ordinate  x and  y in  turn  while  allowing  the 
other  to  vary  with  time  are  given  by 


c*(<)  = [*(0>Sfo]  and  cy(t)  = [z0,  t/(f)]. 


(8.1) 
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The  directional  components  of  the  tangent  vectors  to  these  two  curves  at  time  t are 
given  by 


dcx  . - dx 

~dt  ~ [ ’ l~dt 


and 


= 1°'4 


(8.2) 


Assuming  the  curves  represented  by  (8.1)  are  parameterized  by  unit  speed  so  that 
dx/dt  = 1,  the  directional  components  of  a basis  for  the  tangent  space  at  each  point 
of  R2  is  given  by 

t*  = [1,0]  and  ty  = [0,l].  (8.3) 


From  Section  5.1,  curves  represented  by  (8.1),  which  are  formed  by  fixing  all  but 
one  co-ordinate,  are  called  co-ordinate  curves.  The  directional  components  of  the 
resulting  tangent  vectors,  shown  in  (8.3)  and  formed  by  assuming  unit  speed,  are 
called  co-ordinate  induced  tangent  vectors.  The  magnitude  of  the  area  of  the  square 
formed  by  these  two  vectors  is  equal  to  one. 

In  general,  the  magnitude  of  the  area  of  a parallelogram  formed  by  two  vectors 
in  R2  is  equal  to  the  square  root  of  the  determinant  of  the  2x2  matrix  formed  by  the 
standard  inner  product  of  the  tangent  vectors  h Applying  this  fact  to  the  co-ordinate 
induced  tangent  vectors  found  in  (8.3)  yields 

1The  standard  inner  product  of,  say,  v and  w is  the  scalar  quantity  given  by 

< v,  w >=  | v 1 1 w | cos  6. 

Here  |v|  and  |w|  represent  the  magnitude  of  the  vectors  v and  w,  and  9 represents  the  angle 
subtended  by  them.  Then 


< v,  v > 

< V,  w > 


< V,  w > 

< w,  w > 


< V,  V ><  W,  W > - < V,  W ><  W,  V > 

[|v||v||w||w|  — (|v||w|cos0)2]1/2 

[|v|2|w|2  - |v|2|w|2(l  - sin2  0) Y'2 
|v||w|  sinf?. 


which  is  a more  familiar  form  for  the  magnitude  of  the  area  of  the  parallelogram  formed  by  the  vectors 
v and  w.  See  do  Carmo  [6]  for  more  detailed  exercises  concerning  the  geometric  interpretation  of 
determinants  and  inner  products. 
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^ t x ? ^ ^ ty  ^ 

< 

^ ^ ^y?^y  ^ 


1/2 


= 1. 


Alternately,  in  polar  co-ordinates,  the  curves  formed  by  fixing  each  co-ordinate 
9 and  r in  turn  while  allowing  the  other  to  vary  with  time  yields  the  following  co- 
ordinate curves: 


cr{t)  = [r(t)  cos  60,  r(t)  sin  60]  and  ce(t ) = [r0  cos  9(t),  r0  sin  0(f)]. 

The  co-ordinate  induced  tangent  vectors  are,  thus,  given  by 

tr  = [cos  9,  sin  9]  and  tg  = [— r sin  0,  r cos  0]. 

The  magnitude  of  the  area  of  the  rectangle  formed  by  these  two  vectors  is  then  given 

by 


^ tr 5 tr  ^ ^ ^ 

1/2 

1 0 

tr 

0 r2 

Here,  the  magnitude  of  these  vectors  is  given  by  |tr|  = 1 and  |tg|  = r.  It  is  noted 
that  the  quantity  r appears  in  the  area  element  dA  = r drd9. 

In  general,  if  (U,x)  is  a co-ordinate  chart  on  an  n-dimensional  semi-Riemannian 
manifold  M , the  volume  element  on  U,  in  terms  of  the  co-ordinates  (aq,. . . ,xn),  has 
the  form 


dV  f{^X\, . . . , xn)  dx\  . . . dxn , 


where 


f(x\ , . . . , xn ) — 


< tXl , tXl  > 


T 1/2 


< t xn  5 t X„  > . 


represents  the  magnitude  of  the  volume  of  the  parallelepiped  formed  by  the  co- 
ordinate induced  tangent  vectors  [tXl, . . . , txJ. 
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The  relationship  between  different  co-ordinate  representations  of  the  volume 
element  is  demonstrated  as  follows:  Let  (V,y)  be  another  coordinate  chart  on  M 
such  that  U fl  V 7^  <j).  Let  the  volume  element  on  V,  in  terms  of  the  co-ordinates 
(yi, . . . , yn)  have  the  form 


dV  = <7(2/1, . . . , y„)  dyi . . . dyn, 


where 


g(yu---,yn ) = 


< tyj , tyj  > 


On  the  common  intersection  of  U and  V,  (zi, 
(yi,  • • • ,2/n)  such  that 


1 1/2 

< ^l/n  > ^ yn  > J 

. xn ) are  differentiable  functions  of 


= Zi(2/i,...,2/n) 

— Xn{y\i  . . . , 2/n)-  (8.4) 

Fixing  each  co-ordinate  t/,-  for  i = 1, . . . , n in  turn  while  allowing  the  others  to  vary 
with  time  yields  expressions  for  the  co-ordinate  induced  tangent  vectors  on  (V,y)  in 
terms  of  the  co-ordinate  induced  tangent  vectors  on  (U,  x).  These  are  given  by 


V1  " fefiyi 


uVn 


A dx, 


Thus,  the  two  sets  of  co-ordinate  induced  tangent  vectors  are  related  by  the  Jacobian 
matrix  of  the  co-ordinate  transformation  given  by  (8.4).  Therefore, 
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Jyi 


Vn  . 


5(^1,  • . . , 


d(yi,...,yn) 


1 

tXl 

J nXn 

. t*n  . 

Hence, 


g{yu---,yn ) 

= ^(^1(2/1,  • • • , yn ),  • • • , xn(yi, . . . , yn )) 


yn  dxj  j.  yn 
^ 2^j=l  gyi  lXi,  2^i=l  dyi  *>Xi  -> 


s'  \^n  j5£i+  yn  dxj  x v 

^ Z^i=i  9j/n  i*; , 2^i= 1 9u„  lx,  -> 


9j/n 


d[x\ , . . . , xn) 


t 

j 

’ 

^(2/1,  - • • , 2/e) . 

/(•3'l(?/l)  • • • 1 2/n))  • • • j Xn(j)\  j • • • ) 2/n)) 


5(a^i , . . . , Xn) 


- .ye). 


1/2 


1/2 


Thus 


fi,(j/l),*-?2/n)  f • ^yn)  1 • • • 1 ®n(j/l)  • • • , J/n)) 


• 1 Xn) 

L ^(2/1,  • 

* - , 2/e)  J 

d(xi,. 

.d(yi,. 

dyi,...,dyn 


The  above  summarises  the  effect  of  a change  of  co-ordinates  on  the  volume 
element  and  demonstrates  the  previous  case  of  R2  where 


\d{x,y) 

cos  9 sin  6 

[d(r,6) 

— rsin#  rcos6 

= r. 


See  Boothby  [2]  and  do  Carmo  [6]  for  a generalised  treatment  of  volume  elements  on 
differentiable  manifolds. 
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Figure  8.2.  Parameterization  of  the  Surface  of  the  Sphere 

As  one  final  example,  consider  the  use  of  spherical  co-ordinates  to  parameterize 
the  surface  of  the  sphere  shown  in  Figure  8.2.  The  goal  is  to  find  the  area  element 
on  the  surface  of  the  sphere  and  then  to  integrate  this  element  over  the  sphere  to 
determine  the  surface  area.  When 


x = a sin  <j>  cos  9 
y = a sin  <j>sin  9 
z = a cos  <f>, 

the  co-ordinate  induced  tangent  vectors  on  the  surface  of  the  sphere  are  given  by 

t e = [— a sin  (j>  sin  9,  a sin  <j>  cos  0,0] 

= [a  cos  <f>cos  9,  a cos  ^>sin  0,  — a sin  <j)]. 

Figure  8.3  shows  that  these  vectors  uniquely  define  a tangent  plane  to  the  sphere 
at  every  point  except  the  poles.  The  collection  of  all  tangent  planes  is  the  tangent 
bundle  of  the  sphere. 


Ill 


< tg,  t#  > 

1/2 

a 2 sin2  <j)  0 

< t^, tg  > 

0 a2 

Figure  8.3.  Tangent  Plane  to  the  Sphere 

A metric  on  the  tangent  bundle  is  defined  via  the  standard  inner  product  on  R3. 
That  is,  the  tangent  space  to  the  sphere  simply  inherits  the  metric  of  the  ambient 
space  R3.  The  inner  product  of  two  vectors  in  a tangent  plane  to  the  sphere  is, 
therefore,  defined  to  be  the  inner  product  of  these  two  vectors  as  seen  from  R3.  The 
magnitude  of  the  area  of  the  square  formed  by  the  vectors  is  given  by 

1/2 

= a2  sin  <f>. 

Thus,  the  area  element  for  the  surface  of  the  sphere  is  given  by 

dA  = a 2 sin  (f>d9d(f>. 

Integrating  this  area  element  over  the  surface  of  the  sphere  then  yields 

r2ir  rir 

A = / / a2  sin  <f>dddd>  = in  a2, 

Je= o J<j>= o 

which  is  just  the  surface  area  of  the  sphere. 

The  above  examples  are  presented  to  clarify  the  concept  of  a volume  element, 
and  to  show  how  it  can  be  applied  to  a variety  of  differentiable  manifolds.  The 
form  of  the  volume  element  is,  of  course,  dependent  upon  the  metric  chosen  for  the 
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Figure  8.4.  Definition  of  Planar  Parameters 


manifold.  Any  meaningful  definition  of  volume  must  be  invariant  with  respect  to 
the  co-ordinate  parameterization  of  the  manifold,  much  as  the  concept  of  volume  in 
physical  space  is. 


8.3  Planar  Motion 

Before  applying  the  volume  element  to  a manipulator  capable  of  both  rotational 
and  translational  motion,  it  may  be  instructive  to  investigate  the  simple  case  of  planar 
motion.  Let  T denote  a fixed  frame  in  E2.  Let  T denote  a moving  frame  in  E2.  Let 
g be  the  mapping  of  the  fixed  frame  T to  the  moving  frame  ~T  such  that 

This  is  interpreted  as  the  position  and  orientation,  with  respect  to  the  two  frames, 
of  a planar  body  in  a planar  Euclidean  space  and  is  uniquely  specified  by  the  three 
parameters  (x,y,0)  in  the  manifold  R2  x [0,27t].  See  Figure  8.4  for  a depiction  of 
this  parameterization. 

Proceeding  in  a manner  similar  to  that  of  Section  3.3,  but  using  the  parameter- 
ization given  by 

(x,y,6)  i — » g, 
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one  specifies  g by  the  matrix 


g = 


cos  9 
sin  9 
0 


— sin0  x 
cos  9 y 
0 1 


If  h = \i(xh,,yh,9h)  and  g = g (xg,yg,9g)  represent  finite  planar  motions  then  the 
composition  of  the  two  motions  results  in  a matrix  of  the  form 


cos  9h 

— sin  9h 

Xh  ' 

COS  9g 

— sin  9g 

Xg 

fig  = 

sin  9k 

cos  9h 

Vh 

sin  9g 

cos  9g 

ya 

0 

0 

1 

0 

0 

i 

cos (9h  + 9g)  —sin(9h  + 0g)  xg  cos  9h  — yg  sin  9h  -(-  xh 
sin(9h  + 9g ) cos (9h  + 9g)  xg  sin  9h  + yg  cos  9h  + yh 
0 0 1 


Hence, 


xhg  = Xg  cos  9h  - yg  sin  9h  + xh 
yhg  = xg  sin  9h  + yg  cos  9h  + yh 
@hg  = 9h  + 9g. 

From  Sections  5.2  and  5.3,  it  is  known  that  if  h = h(f)  is  function  of  time  and 
g - go  is  fixed,  then  h(f)g0  represents  the  same  motion  of  the  body  in  space  and 
time,  but  with  a change  in  the  moving  frame.  Similarly,  if  h = h0  and  g = g(<),  then 
fiog(  t)  is  the  same  motion  of  the  body  in  space  and  time,  but  with  a change  in  the 
fixed  frame.  A volume  element  on  this  manifold  must  be  invariant  with  respect  to 
these  co-ordinate  changes  if  it  is  to  be  meaningful. 

In  proceeding  to  define  a volume  element,  the  co-ordinate  induced  tangent  vec- 
tors to  the  motion  h(i)go  are  examined  first.  These  are  given  by 
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tx  = [1,0,0] 

ty  = [0,1,0] 

t*  = [— Xjsin^  - yg  cosOh,xg  cos6h  - yg  smOh,  1].  (8.5) 

Similarly,  the  co-ordinate  induced  tangent  vectors  to  the  motion  h0g(i)  are  given  by 


tx  = [cos  Oh,  sin  Oh,  0] 

ty  = [—sinOh,  cos  0h,0] 

tfl  = [0,0,1].  (8.6) 


If  the  standard  inner  product  on  a three  dimensional  space  is  chosen  as  the 
metric,  it  is  found  that  the  magnitude  of  the  volume  of  the  parallelepipeds  formed 
by  (8.5)  and  (8.6)  are  the  same.  In  particular,  the  magnitude  is  given  by 

1/2 


^ t y>  t X ^ "C  ty,  ty  > < ty,t#  ]> 

^ tj,  tX  > < t^,ty  > < t$,  > 


= 1. 


Thus,  the  volume  element  for  the  manifold  is  given  by  dV  — dOdxdy  and  the  quantity 


V = J dddxdy,  (8.7) 

when  integrated  over  some  subset  of  all  possible  planar  motions,  yields  an  invariant 

quantity  representing  the  area  over  which  one  can  translate  an  object  times  the 

average  angle  through  which  the  object  can  be  rotated  at  each  point  2. 

2It  is  noted  that,  while  the  volume  given  by  (8.7)  is  invariant,  the  metric  from  which  it  is  derived 
is  not.  Thus,  the  metric  imposed  on  the  planar  group  of  motions  does  not  represent  a geometrically 
meaningful  quantity.  However  the  resulting  volume  element  does.  It  is  further  noted  that  one 
can  also  approach  the  concept  of  volume  via  differential  forms  which  omits  the  need  for  a metric. 
Arguably,  this  approach  does  not  convey  the  relationship  of  Lie  groups  to  screws  as  readily,  but  is 
more  succinct  in  form. 
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Figure  8.5.  Planar  RRR  Robot 


Consider,  now,  the  planar  RRR  robot  shown  in  Figure  8.5.  The  position  and 
orientation  of  the  end  effector  space  with  respect  to  the  base  space  is  restricted  by  the 
configuration  of  the  manipulator.  This  induces  a reparameterization  of  the  manifold 
R2  x 27 r in  terms  of  the  joint  angles  01,02, 03 • The  original  parameterization  is  related 
to  the  joint  angle  parameterization  via  the  forward  analysis  for  the  manipulator,  and 
yields 


X = d\2  COS  0\  + <Z23  COs($i  + 02 ) + 034  COs($i  -f  02  + $3) 
V — °h2  sin  0\  + a23  sin(#i  + 02)  + sin($i  -f-  02  + $3) 

0 = 0\  4*  02  + 03- 

The  co-ordinate  induced  tangent  vectors  are  then  given  by 


t01 

te2 

= 

. ^3  . 

dx/d0 1 3y / d0\  30/30x 
dxld02  dy/302  30/302 
3x/30 3 dy/303  30/30 3 


tx 

More  explicitly, 
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t0i 


te2 


te3 


—ai2  sin(#i)  - a23  sin(6h  + 02)  - a34  sin(0a  + 02  + 03 ) 
012  cos($i)  + a23cos(04  + 92)  + a34cos(0i  + 02  + O3) 

1 


— a23sin(#i  + 92)  — a34sin(#i  + 92  + 93) 
a23  cos(0i  + 62)  + a34  cos(0j  + @2  T $3) 
1 


— a34sin(^i  + 62  + 93) 
a34  cos(#j  + 62  + $3) 

1 


The  magnitude  of  the  volume  of  the  parallelepiped  formed  by  these  tangent 
vectors  is  given  by 


< , tg1  > < tflj , tg2  > 

^ 1^2  ) ^$1  ^ ^ f #2  1 ^$2  ^ 

< tg3 , tgj  > < t$3 , t g2  > 


^ t^l  5 t$3  ^ 
^ ^#2  > ^$3  ^ 
^ ^#3  > ^#3  ^ 


1/2 


a12a23|  sin  02|. 


(8.8) 


Hence,  the  volume  element,  in  terms  of  the  joint  angle  parameterization,  is  given  by 


dV  = ai2a23|  sin  ^2|d^1d^2d^3. 


It  is  interesting  to  note  that  dV  = 0 when  sin02  = 0,  a12  = 0,  or  a23  = 0. 
At  any  of  these  values,  the  three  linearly  independent  tangent  vectors  forming  the 
parallelepiped  collapse  to  form  a two-system.  The  tangent  vectors  represent  the 
instantaneous  motions  of  the  end  effector.  Hence,  the  loss  of  one  or  more  of  these 
vectors  represents  a loss  in  a degree  of  freedom,  and  the  volume  element  degenerates 
precisely  when  the  robot  is  in  a singularity  configuration. 

The  volume,  or  what  is  referred  to  as  the  motion  capability , achieved  by  the 
robot,  assuming  all  joints  can  rotate  27t  radians,  is  given  by 


V = 


r 2jt  r2ir  j-2tr 

J6 1 =0  Jo 2=0  Jo 3=0 


Oi2023\sm92\d9id02d63  = 167r2ai2a23. 


This  is  further  expressed  in  the  form 
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Figure  8.6.  Physical  Workspace  of  Planar  RRR  Robot 


V - 167r2a12ct23  = 47 r x [7r(ai2  + a23)2  - 7r (a12  - a23)2]. 

As  can  be  seen  in  Figure  8.6,  the  motion  capability  of  robot  is  47 r times  the  area  of 
the  shaded  annulus.  This  annulus  is  called  the  physical  workspace  of  the  robot.  It  is 
noted  that  the  physical  workspace  is  independent  of  the  selection  of  frames  used  to 
parameterize  the  base  and  end  effector  space.  It  is  the  actual  area  over  which  the  end 
effector  space  can  translate  with  respect  to  the  base  space.  The  factor  47T  = 2 x 2ir 
radians  indicates  that  there  is  a double  covering  of  the  physical  workspace,  and  that 
the  lobot  can  rotate  the  body  2ir  radians  about  any  point  in  the  physical  workspace. 

More  generally,  the  geometric  interpretation  for  the  motion  capability  of  a planar 
robot  is  the  area  of  the  physical  workspace  times  the  average  angle  (inclusive  of 
multiple  coverings)  over  this  workspace  through  which  the  end  effector  space  can 
rotate  with  respect  to  the  base  space. 

To  aid  in  understanding  motion  capability  further,  it  may  be  useful  to  consider 
another  planar  robot  design.  Consider  the  PRP  robot  shown  in  Figure  8.7.  This 
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robot  induces  a reparameterization  of  the  manifold  R2  x 2i r via  the  forward  analysis 
which  yields 


x = Si  + s2  cos  0i 
y = s2  sin  0i 

0 = 0i. 

The  co-ordinate  induced  tangent  vectors  are  then  given  by 


t«2 

— 

dx/dsi 

dx/ds2 

dx/d0\ 


dy/ds! 
dy/ds2 
dy/d0 1 


d0/ds\ 

d0/ds2 

d0/d01 


t 


Si 


ts2 


1 

0 

0 


COS  01 
sin  0i 
0 


This  yields 
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Figure  8.8.  Physical  Workspace  of  Planar  PRP  Robot 


— s2  sin  6\ 
s2  cos  0\ 

1 


The  magnitude  of  the  volume  of  the  parallelepiped  formed  by  these  tangent  vectors 
is  given  by 


< tS2  , tSl  > 

< i tSl  > 


< tSl  , tS2  > 


< , tflj  > 


1/2 

= | sin$i|. 


Thus,  the  volume  element  in  terms  of  this  parameterization  is 


dV  = | sin  Oi\ddidsids2. 


Again,  the  volume  element  correctly  predicts  the  singularities  of  the  robot  which 
occur  when  sin  9X  = 0. 

The  motion  capability  of  the  robot,  assuming  the  revolute  joint  can  rotate 
radians  and  the  prismatic  joints  are  restricted  to  G [0,px]  and  s2  € [0,p2],  is  given 

by 


V = 


sin0i\d0ids\ds2  = Apip2. 
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The  relationship  between  this  quantity  and  the  area  of  the  robot’s  physical  workspace, 
which  is  2pip2  + 7rp22  and  is  illustrated  in  Figure  8.8,  is  not  as  obvious  as  it  is  in  the 
case  of  the  RRR  robot.  This  is  because  the  PRP  robot  does  not  achieve  a simple 
integral  multiple  covering  of  its  workspace.  Furthermore,  the  angle  through  which 
the  robot  can  rotate  the  end  effector  space  with  respect  to  the  base  space  varies  with 
position  and  is  also  dependent  on  the  parameters  p\  and  p2.  This  average  angle  is, 
in  fact, 


4pip2 


radians. 


2pip2  + 7TP22  2 + 7T^ 

It  may  now  be  interesting  to  determine  those  parameters  which  will  optimize 
the  motion  capabilities  of  the  PRP  and  RRR  robots,  subject  to  certain  practical 
constraints,  and  then  to  draw  a comparison  and  conclude  which  design  is  superior. 
Imposing  a restriction  on  the  size  of  the  physical  workspace  of  the  RRR  robot  via 
the  equation  ai2  + a23  = 2a,  where  a is  a constant,  yields  the  motion  capability  as  a 
function  of,  say,  ai2.  Thus, 


^(012)  = 167r2a12(2a  - ai2). 

It  can  easily  be  deduced  that  the  maximum  motion  capability  is  attained  when  ai2  = 
a23  = a.  At  this  value,  the  void  in  figure  8.6  disappears  and  the  physical  workspace 
covers  a circle  of  radius  a12  + a23  = 2a.  This  maximum  motion  capability  shall  be 
denoted  by 


Vrrr  = 2 x 27t  x 7r(2a)2. 

Dividing  this  result  by  the  area  of  the  physical  workspace  of  the  robot  yields 


Vrrr 


7t(2  a)2 


= 2 x 27 r. 


(8.9) 
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Equation  (8.9)  shows  that  the  RRR  robot  achieves  a double  covering  of  its  physical 
workspace  and  is  able  to  rotate  the  end  effector  space  2k  radians  about  any  point  in 
the  physical  workspace. 

Similarly,  imposing  a restriction  on  the  size  of  physical  workspace  of  the  PRP 
robot  via  the  equation  px  +p2  = p,  where  p is  a constant,  yields  the  motion  capability 
as  a function  of,  say,  px.  Thus, 

V(Pi)  = 4pi(p-pi). 

Here,  the  maximum  motion  capability  is  attained  when  px  = p2  = \p  and  it  is  given 

by 


VpRP  = p2 . 

Dividing  this  result  by  the  area  of  the  physical  workspace  of  the  robot  yields 

VpRP  A. 

VW)  = ^r+2  ~ ,78 radians-  (8-10) 

4 

Equation  (8.10)  shows  that  the  PRP  robot,  in  contrast  to  the  RRR  robot,  can  rotate 
the  end  effector  space  an  average  of  44.5  degrees  about  every  point  in  its  physical 
workspace. 

These  results  demonstrate  that  the  motion  capability  of  the  the  planar  RRR 
robot  is  superior  to  that  of  the  planar  PRP  robot. 

8.4  Redundant  Planar  Motion 

Consider,  now,  the  redundant  planar  4 R robot  shown  in  Figure  8.9.  The  redun- 
dancy introduced  complicates  the  problem  of  defining  the  motion  capability  of  the 
robot.  However,  it  is  still  possible  to  obtain  a geometrically  invariant  result. 

The  forward  analysis  for  the  robot  is  given  by 
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X = 0,12  cos  0a  + a23  cos(0x  + 02 ) + a34  cos(0!  + 02  + 03)  + a45  cos(0i  + 02  + 03  + 04) 
y = 0-12  sin  0J  + a23  sin(0!  + 02)  + a34  sin(0i  + 02  + 03)  + a45  sm(0j  + 02  + 03  + 04) 

0 = 0i  + 04  + 03  + 04. 


The  redundancy  is  manifested  by  the  fact  that  the  three  dimensional  group  of 
planar  motions,  given  by  the  variables  (x,y,6),  has  been  reparameterized  in  terms 
of  the  four  variables  (0i,  02, 03, 04).  This  results  in  four  co-ordinate  induced  tangent 
vectors  existing  in  a three  dimensional  tangent  space  at  each  point  on  the  manifold. 
These  are  given  by 


More  explicitly 


^#2 

^#3 

. u* . 

dx/ddi  dy/de i de/ddi 
dx/de2  dy/( 902  d 0/d92 
dx/de3  dy/de3  oe/de3 

dx/d&4  dy/dd4  do/de 4 


' t, ' 

. 

ai2sin(0i)  — a23sin(0!  -)-  02)  — a34sin(0!  + 02  + 03)  — a45sin(0x  + 02  -f  03  + 04) 
a12  cos(0! ) + a 23  cos(0i  + 02)  + a34  cos(0i  + 02  + 03)  + a45  cos(0!  + 02  + 03  + 04) 

1 
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U3 


t»4 


—023  sin($i  4-  @2)  - 034  sin(#i  + d2  + $3)  — a45  sin(#i  4-  02  4-  O3  + O4) 

023  COs(<?x  + #2)  + 034  cos(0i  + 02  + $3)  + a45  COs((?i  + $2  + O3  + 64) 

1 


—034  sin($i  4*  02  + $3)  — a45  sin(0i  4-  02  4-  O3  4"  $4) 
034  cos((?i  4-  #2  4-  $3)  4-  045  cos(#i  4-  #2  4-  #3  4-  O4) 
1 


— 045  sin(#i  4-  62  4"  $3  4-  O4) 
045  cos(#i  4-  #2  4-  #3  4-  #4) 
1 


These  four  vectors  must  be  linearly  dependent.  It  does  not,  of  course,  make 
sense  to  consider  a parallelepiped  spanned  by  all  four  vectors,  but  it  is  possible  to 
consider  a parallelepiped  formed  by  any  three  of  these  vectors.  This  fact  is  used  to 
define  the  motion  capability  of  the  4 R robot  in  the  following  manner: 

The  magnitude  of  the  volume  of  the  parallelepiped  formed  by  omitting  tgt  is 
given  by  (8.8),  and 


f \ — ai2°23|  sin  $2!- 

Similarly,  omitting  $3,  #2  and  0\  in  turn  yield  parallelepipeds  with  volumes 


h — 012034!  sin(02  + 03)|  + «i2«23|  sin  02| 

/2  = a12a34|  sin(02  -f  03)|  + a23a34|  sin  03| 

/1  = a23a34|  sin  03|. 

Consider,  now,  that  /2  is  a function  of  the  omitted  joint  angle  02.  Keeping  02 
fixed,  the  motion  capability  ^2(^2)  of  the  resultant  RRR  robot  is  given  by 


rZ  7r 

W2)  = / h d0\d6s dO 4 

i®3  ,#4=0 

= 167r2a12a34(|  sin  02|  + | cos  02 1)  + 167r2a23a34. 
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Further  examination  of  V 2(#2 ) reveals  that  the  motion  capability  of  the  resultant 
three-degree-of- freedom  robot  is  a relative  maximum  when  02  = (2n  + 1)^  and  a 
relative  minimum  when  02  = nf  for  n = 0, . . . , 3.  Precisely  the  same  results  can  be 
deduced  from  f3  which  is  a function  of  the  missing  joint  angle  93. 

It  is  interesting  to  note  that  the  expression  for  f4  is  the  same  as  (8.8)  which 
is  the  volume  element  of  the  RRR  robot  analyzed  in  the  previous  section.  This  is 
consistent,  since  keeping  the  last  joint  fixed  is  equivalent  reparameterizing  the  end 
effector  space  of  the  RRR  robot.  This  is  an  action  with  respect  to  which  all  results 
are  invariant. 

In  the  same  way,  the  expression  for  f4  appears  similar  to  (8.8)  with  the  appropri- 
ate change  in  a link  length  and  joint  angle.  Keeping  the  first  joint  fixed  is  equivalent 
to  reparameterizing  the  base  space  of  the  RRR  robot.  This  is  again  an  action  with 
respect  to  which  all  results  are  invariant. 

Integrating  each  function  Vi(0,),  for  * = 1, ...  ,4,  with  respect  to  the  previously 
fixed  angle  9i,  over  the  range  0 < 9{  < 2x,  and  dividing  by  2n  yields  an  average  value 
of  the  motion  capability  of  each  RRR  robot  which  is  dependent  on  the  configuration 
of  each  redundant  joint  3.  The  integration  and  averaging  of  each  V{[9i)  is  denoted  by 


1 /** 

Mi  = — Viddi 

I'K  J0i=  0 

1 r 

2i r J Q\y...,Q4—o 

In  particular,  these  intermediate  values  of  motion  capability  are  given  by 


fi  d94d92d93d94 


.Mi  ■ 167r2a23a34 

3Tlhs  procedure  applies  the  arithmetic  mean  to  the  function  Vt . It  is  possible  that  other  means 
could  be  used  which  do  not  treat  each  joint  equally,  but  emphasise  or  de-emphasise  the  contribution 
of  a particular  joint  based  on  the  intended  application  of  the  robot. 
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M2  = 167ra34(7ra23  + 4ai2) 

M3  = 167rai2(7ra23  + 4a34) 

M4  = 167r2a23ai2.  (8-11) 

Finally,  the  motion  capability  of  the  4 R robot  is  defined  to  be  the  average  of  the 

intermediate  values  M;.  Hence, 


M — —(Mi  T M2  T M3  T M. j) 
4 


1 4 r2* 

/ fid01dd2d93d04. 

4 x 27 r ££Je1,...,0i=o 


(8.12) 


Equation  (8.12)  represents  an  invariant  definition  of  motion  capability  for  a 
redundant  planar  4 R robot.  It  is  the  average  of  the  intermediate  values  of  motion 
capability.  These  intermediate  values  reflect  the  importance  of  each  joint  . This  claim 
is  demonstrated  by  the  following  analysis:  First  optimize  the  design  by  imposing  a 
restriction  on  the  physical  workspace  of  the  4 R robot  via  the  equation  ai2-f-a23+a34  = 
3a.  One  can  deduce  that  the  intermediate  values  in  (8.11)  are  maximized  when 
«i2  = «23  = a34  = a.  These  are  given  by 


Mimax  = 167T2a2 

M2max  = 167T2a2(l  + -) 

7 r 

M3max  = 167r2a2(l  + -) 

7 r 

M4max  = 1 67 r a . (8.13) 

It  is  clear  that  M2max  and  M3max  are  the  largest  intermediate  values.  These 
values  correspond  to  the  average  motion  capability  of  the  resultant  RRR  robots 
formed  by  freezing  the  second  and  third  joints  respectively.  It  is  noted  that  freezing 
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these  joints  eliminates  their  contribution  to  the  motion  capability  of  the  resultant 
RRR  robots.  Since  the  associated  intermediate  values  are  the  largest,  this  implies 
that  the  RRR  designs  which  actually  use  the  second  and  third  joints  generate  smaller 
intermediate  values.  Thus,  the  second  and  third  joints  are  the  least  important  joints 
of  the  4 R robot. 

In  contrast,  the  first  and  fourth  joints  are  the  most  important  joints,  as  the 
associated  intermediate  values  are  the  smallest.  It  is  interesting  to  note  that  the 
intermediate  value  representing  the  motion  capability  of  the  resultant  RRR  robot 
formed  by  freezing  the  first  or  fourth  joint  is  independent  of  the  particular  angle  at 
which  these  joints  may  be  frozen.  In  fact,  the  values  of  Mimax  and  M4max  are  identical 
with  the  RRR  robot  examined  in  Section  8.3.  This  is  because  the  magnitude  of  the 
volume  of  the  parallelepiped  formed  by  omitting  the  first  or  fourth  joint,  given  by 
V(6i)  or  V(04),  is  independent  of  the  the  first  or  fourth  joint  respectively.  Hence, 
these  joints,  which  are  the  most  important  to  the  4 R robot,  appear  to  leave  the 
associated  intermediate  values  of  motion  capability  invariant. 

One  can  proceed  to  define  the  motion  capability  of  a 5 R robot  in  a similar 
fashion,  by  freezing  two  joints  at  a time  and  in  turn  integrating  the  volume  of  the 
resultant  parallelepiped  over  these  redundant  joints.  It  can  be  seen  that  this  will 
result  in  ten  intermediate  values  of  motion  capability  which  must  then  be  averaged 
to  determine  the  motion  capability  of  the  5 R robot. 

8.5  Euclidean  Motion 

The  concept  of  a volume  element  will  now  be  applied  to  the  Euclidean  group  G. 
Let  T be  a frame  at  rest  with  respect  to  a fixed  space  E3,  and  let  T be  a frame  at 
rest  with  respect  to  a moving  space  E . Let  g be  the  mapping  which  takes  the  fixed 
frame  F to  the  moving  frame  T such  that 
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g-.T^T. 

Then  g uniquely  gives  the  position  and  orientation  of  the  body  with  respect  to  the 
two  frames.  From  Section  3.3,  it  is  known  that  g is  specified  by  the  six  parameters 
(<p,  9,  ip,  x,  y , z ) where 


sin  <p  sin  9 x 

- cos  <p  sin  6 y 

cos  9 z 

0 1 

(8.14) 


Ifg  is  made  a function  of  time  then 

g(t)  = g (<p(t),  9{t),  x(t),  y(t),  z(t ))  (8.15) 

represents  a curve  in  G.  Section  5.2  showed  that  the  components  of  the  fixed  gener- 
alised axode  of  this  motion  are  given  by 


g = 


cos  <p  cos  ip  — sin  <p  sin  ip  cos  6 
sin  <p  cos  ip  + cos  <p  sin  ip  cos  6 
sin  ip  sin  6 
0 


— cos  (p  sin  ip  — sin  (p  cos  ip  cos  6 

— sin  cp  sin  ip  + cos  (p  cos  ip  cos  6 

cos  ip  sin  6 
0 


X(t) 


cos  <p9  4-  sin  (p  sin  9ip 
sin  (p9  — cos  <p  sin  9ip 
(p  + cos  9ip 

y((p  + cos  9ip)  — z(sin  <p9  — cos  <p  sin  9xp)  + x 
—x{(p  + cos  9ip)  + 2:(cos  <p9  + sin  <p  sin  9ip)  + y 
. z (sin  cp9  - cos  (p  sin  9ip)  - y{ cos  <p9  + sin  <p  sin  9ip)  + i 


Permitting  each  of  the  six  variables  (< p,ip,9,x,y,  z ) to  vary  in  turn,  while  keeping 
the  other  five  variables  fixed,  yields  the  following  six  parameter  induced  co-ordinate 


vectors: 
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' 0 ' 

COS  (j> 

0 

sin  (f) 

1 

0 

y 

J Xtf  — 

—2  sin  <j> 

— X 

z cos  </> 

0 

x sin  < f>  — y sin  ^ 

X 


* = 


sin  sin  9 
cos  (f>  sin  9 
cos  9 

y cos  9 + z cos  </>  sin  9 
—x  cos  9 + z sin  q i sin  9 
—x  cos  (f>s'm9  — y sin  (f> sin  9 


i 

0 

1  

1 

o 

o 

0 

0 

0 

0 

0 

0 

1 

5 Xy  — 

0 

, X,  — 

0 

0 

1 

0 

1 

o 
1 

1 

o 
1 

. 1 . 

Using  the  invariant  metric  defined  in  Chapter  7,  the  magnitude  of  the  volume 
of  the  parallelepiped  spanned  by  the  above  vectors  is  given  by 


< x^, 

> 

< X^,X^  > 

< X#,  Xg  > 

< X0 , Xx 

> 

< X^,  Xy 

> 

< x0,x*  > 

< Xe,  x^ 

> 

< Xg,X^,  > 

< x#,x» 

> 

<Xe,Xx 

> 

< X*,Xy 

> 

< x*,x,  > 

< X*. 

X* 

> 

< X,p , Xfj,  > 

< X^, , Xg 

> 

x^ , Xx 

> 

< Xfp  , Xy 

> 

< Xy  j X2  > 

x* 

> 

< Xx,X^,  > 

<xE,xe 

> 

<Xx,Xx 

> 

< Xr,Xy 

> 

< x*,x2  > 

<xy, 

x0 

> 

^ Xy  , XfJj  > 

<Xy,X« 

> 

<[  Xy  , Xr 

> 

<Xy,Xy 

> 

<Xy,X,  > 

<X,, 

x* 

> 

<X;,Xi,> 

<x2,xe 

> 

<X,,Xx 

> 

<X,,Xy 

> 

<x,,x,  > 

0 

0 0 

0 

0 

1 

1/2 

0 

0 0 

cos  <j> 

sin<^ 

0 

0 

0 0 

sin  <j>  sin  9 

cos  <f>  sin  9 cos  9 

0 

cos  4>  sin  <j>  sin  9 

0 

0 

0 

0 

sin  <j>  cos  <j)  sin  9 

0 

0 

0 

1 

0 cos# 

0 

0 

0 

1/2 


- sin  9. 
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Hence,  the  volume  element  for  the  Euclidean  group  is  given  by 

dV  = sin  9d<f)d9dipdxdydz. 

The  physical  interpretation  of  this  volume  element  is  as  follows:  If  the  possible 
translations  of  a body  are  restricted  to  (x,y,z)  £ [0,a]  x [0,6]  x [0,c]  and  no  restric- 
tion is  placed  on  the  orientation,  so  that  (ip,<f>,9)  € [0, 27r)  x [0,2*)  x [0, 7r] , then 

V = y sin  9d(j)d9dxl)dxdydz  = Sn2abc.  (8.16) 

The  quantity  abc  is  the  physical  volume  over  which  the  body  can  translate.  The  value 
8tt2  can  be  shown  to  be  the  volume  of  the  subgroup  of  rotations,  S'0(3),  when  the 
standard  inner  product  of  the  angular  velocity  vector  is  the  metric  of  choice.  Hence, 
the  volume  of  the  subset  of  the  Euclidean  Group  represented  by  (8.16)  is  the  product 
of  the  volume  of  50(3)  and  the  physical  volume  of  the  space  over  which  the  body 
can  translate. 


8.6  Application  to  a Typical  Industrial  Robot 

The  volume  element  is  now  applied  to  a typical  industrial  robot  with  six  revolute 
joints.  Consider  figure  8.10  which  shows  a skeletal  model  of  three  adjacent  joints  in 
a manipulator.  The  joint  axes  are  labeled  sequentially  by  with  the  vectors  S,_i,  S 
S,-+i.  The  direction  of  the  common  normal  between  the  two  successive  joints  axes  S, 
and  S,+i  is  labeled  with  the  vector  at>t+1 . The  length  of  the  vector  a,it+1  is  denoted 
by  a,-,i+i. 

The  mutual  perpendicular  distances  between  pairs  of  successive  links  a,_lit-  and 
a!,t+i  are  labeled  Si  and  are  called  offsets.  The  twist  angles  are  labeled  a,tl+1  and  are 
defined  by  the  angle  measured  by  a right-handed  rotation  of  S,  into  S.+i  about  the 
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axis  a,jt+1.  The  joint  angles  are  labeled  and  are  defined  by  the  angle  measured  by 
a right-hand  rotation  of  into  a,)1+1  about  the  axis  S,-. 

The  vectors  a,-_i(<  and  S,  define  the  x and  z- axes  of  a frame  T respectively. 
The  vectors  a,it+1  and  S,+i  define  the  x and  z-axes  of  a frame  T respectively.  The 
sequence  of  transformations  of  the  frame  T to  T are  defined  in  terms  of  the  above 
vectors  and  angles  as  follows:  Let 


0 0 0 0' 

0 10  0 

0 0 1 Si 
0 0 0 1 


to  be  the  translation  required  to  map  the  point  Tq  to  the  intersection  of  the  vectors 
Sj  and  a^,+1.  Define 


= -^gi- 

Next,  let 

’ cos  6i  — sin  0i  0 0 
sin  cos  9i  0 0 

0 0 10 

.0  0 0 1 


g2  = 
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applied  to  T\  is  a rotation  about  T\z  in  the  positive  sense.  Define 


2 = 1 g2  • 


Then  is  collinear  with  Tx.  Next,  let 


1 0 0 ai>t+ 1 

0 10  0 
0 0 1 0 

0 0 0 1 


applied  to  Ti  is  a translation  along  Fix  in  the  positive  direction.  Define 


^3  = ^2g3  • 


Then  is  co-incident  with  Fx. 

Next,  let 

0 0 ' 

- sin  Qi)t+1  0 
cos  a, •,,•+!  0 

o’  1 . 

applied  to  Tz  is  a rotation  about  Tzx  in  the  positive  sense.  Then 


1 0 
0 cos  a,,,+1 
0 sin  at)t+1 
0 0 


? = ^3g4- 


Thus, 


? = ^glg2g3g4 


= *g, 


g = 


cos  0,- 
sin  0, 
0 
0 


— cos  a,-)t-+i  sin  0, 
cos  cos  0,- 
sin  aiti+1 
0 


sin  at|t+i  sin  0,-  a,-it+1  cos  6t 

— sin  a,-,l+i  cos  0,  a,t,+1  sin  0,- 

cos  a, ■,,•+!  Si 

0 1 


where 
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Now  consider  the  General  Electric  P60  industrial  robot.  A kinematic  model  of 
the  GE  P60  is  given  in  Figure  8.11  showing  the  definitions  of  the  joint  angles  0j, 
twist  angles  ortJ- , offsets  Sj  and  link  lengths  a,y.  It  is  noted  that  only  the  joint  angles 
are  the  variable  quantities  for  the  manipulator.  All  other  parameters  have  constant 
values  which  are  presented  in  Table  8.1. 

Using  these  parameters,  the  mapping  of  a frame  T at  rest  with  respect  to  the 
base  space  of  the  robot,  to  a frame  T at  rest  with  respect  to  the  end  effector  space 
of  the  robot  is  given  by  the  matrix 


i=6 

g = n 

t=i 


cos  0,  — cos  a.,,+1  sin  0,-  sin  a,)l+i  sin  0,-  a,,,+i  cos  0, 

sin  0,-  cos  atii+i  cos  0;  — sin  a,it+1  cos  0,  ati,+i  sin  0,- 

0 sma,)i+1  cos  a,il+1  S ,• 

0 0 0 1 


where  each  matrix  in  the  product  represents  the  mapping  of  the  frame,  identified  with 
the  ith  joint  into  the  (i  -f  l)th  joint.  This  is  a rather  lengthy  matrix  whose  elements 
are  a function  solely  of  the  joint  angles  0i  . . . 06.  This  matrix  is  given  explicitly  in 
Appendix  A.  For  brevity,  this  matrix  is  denoted  by 


g = 


011  012  013  9x 

021  022  023  gy 

031  032  033  02 

0 0 0 1 


(8.17) 


Allowing  6i  for  i = 1, . . . , 6 to  vary  with  time,  while  keeping  all  other  joint  angles 
fixed,  results  in  a curve  with  a co-ordinate  induced  tangent  vector  given  by 

X,  = X-^4-X  — 4-X  ^4-X  dx  -L  Y dy  . Y dz 

’■  *de,  + ‘ae,  + + + + x‘ae,' 


Thus,  the  joint  angle  co-ordinate  induced  tangent  vectors  are  related  to  the  Euler 
co-ordinate  induced  tangent  vectors  by  the  Jacobian  matrix  of  the  co-ordinate  trans- 
formation, and  is  given  by 
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5 

Q 67 


Ol2  = 

0 cm 

ai2  = 

90  ° 

s2  = 

0.0  cm 

<*23  = 

70  cm 

«23  = 

0 0 

s3  = 

0.0  cm 

°34  — 

90  cm 

C*34  = 

0 ° 

s4  = 

-9.8  cm 

a45  = 

0 cm 

045  = 

90  0 

= 

14.5  cm 

a 56  = 

0 cm 

C*56  = 

CO 

O 

o 

Table  8.1.  Mechanism  Parameters  for  the  GE  P60  Robot 
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r x*  i 

r x0  ] 

X„2 

x, 

X5s 

d(<l>,0,ip,x,y,z) 

Xv, 

X04 

p{9\,  02,  03,  04,  05,  9&) 

6x6 

xx 

x*5 

X, 

LX*6  j 

L x,  J 

(8.18) 


The  magnitude  of  the  volume  of  the  parallelepiped  spanned  by  the  joint  angle  induced 
basis  is  given  by 


< X#j , Xgj  > . . . 


1 1/2 


• • • < Xfl6 , Xe6  > . 


\9(<f>,0,ip,x,y,zy 

t 

< Xj,,  X^  > . . . : 

'd(<p,0,rp,x,y,z)  1 

d(eu...,06)  J 

: ...  < x2,xz  > 

d(0i,...,0e)  J 

— sin  6 


'd(4>,6,ip,x,y,z)  1 

. d(9u...,06)  J ' 


(8.19) 


By  comparing  (8.14)  and  (8.17),  one  can  deduce  the  expressions  which  relate  the 
initial  parameterization  of  E3,  in  terms  of  (cp,6,ip,x,y,z)  to  the  parameterization  of 
E3  using  the  joint  angles,  01,...,06.  This  yields 


tan  (j) 

~ — <713/  9' 

cos  9 

= 933 

tan  ip 

- 931  / 932 

X 

= 9x 

y 

= 9y 

z 

= 9z ■ 

Hence, 
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Furthermore, 


Thus, 


d<p 

dot 

#13  + #23 

de 

dg33  1 

dOi 

m'  l/l  - 9l 3 

dip 

^f#32  ~#31^f 

dOi 

#31  + #32 

dx 

dgx 

ddi 

ddi 

dy 

dgy 

de{ 

ddi 

dz 

dgz 

d0i 

ddC 

~#33- 


(8.20) 


It  is  also  noted  that 


■ 

SmV 


d<?33 
dOi  ' 


(8.21) 


#13  T #23  — #31  T #32  • 


(8.22) 


Hence,  the  volume  element  given  by  (8.19)  and  rewritten  using  the  substitutions 
given  by  (8.20),  (8.21),  (8.22),  results  in 
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dv  = <ZMMMMM06, 

(#13  + 923) 

where  J is  a 6 x 6 matrix  whose  elements  are  functions  of  the  joint  angles.  Explicit 
expressions  for  J and  (g23  + gl3)2  are  given  in  Appendix  A.  These  are  seen  to  be 
rather  lengthy. 

After  some  careful  symbolic  manipulation,  one  finds  that  the  volume  element 
reduces  to  the  following  compact  expression: 

dV  = a23a34  sin  $3  sin  #5(55  sin  $432  + a34  cos  $32  + a23  cos  02)  dOid02dO3d04d05dO6. 

Here,  0432  = $4  + 03  + 02  and  032  = 03  + 02. 

It  is  noted  that  the  volume  element  is  independent  of  the  first  joint  angle  0\. 
This  is  because  the  value  of  $1  is  dependent  on  the  parameterization  of  the  base  space. 
The  volume  element  is  invariant  with  respect  to  this  choice,  hence  the  angle  does  not 
appear.  It  is  also  noted  that  Se,  a56,  £*67  do  not  appear  in  the  volume  element.  This 
is  because  the  choice  of  these  values  are  dependent  on  the  parameterization  of  the 
end  effector  space.  This  is  also  a choice  with  respect  to  which  the  volume  element  is 
invariant. 

It  is  interesting  to  note  that  the  volume  element  degenerates  to  zero  when 


sin  03  = 0 
sin  $5  = 0 

S5  sin  $432  T a34  cos  $32  “f*  ^23  cos  $2  = 0. 

These  three  expressions  correspond  to  the  singularity  configurations  of  the  robot, 
where  the  motion  of  the  end  effector  space  with  respect  to  the  base  space  has  lost 
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one  or  more  degrees  of  freedom.  The  geometry  of  the  robot  configurations  corre- 
sponding to  these  singularities  are  illustrated  in  Figures  8.12,  8.13,  and  8.14.  They 
are  interpreted  as  follows:  Figure  8.12  depicts  a loss  in  translational  capability  in 
the  direction  parallel  to  the  line  through  the  center  of  the  second,  third  and  fourth 
joints.  Figure  8.13  depicts  a loss  in  translational  capability  in  the  direction  parallel  to 
the  second,  third,  fourth  and  sixth  joints.  Figure  8.14  depicts  a loss  in  translational 
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Figure  8.14.  GE  P60  singularity  S5  sin  0432  + a34  cos  032  + a23  cos  02  = 0 

capability  in  the  direction  parallel  to  the  second,  third  and  fourth  joints.  In  this 
figure,  the  first  and  sixth  joints  are  collinear. 

One  may  proceed  to  numerically  integrate  the  volume  element  function  and 
produce  a quantity  representing  the  motion  capability  of  the  6 R robot.  This  number 
provides  an  unambiguous  quantitative  comparison  of  the  GE  P60  robot  with  other 
robots  possessing  six  degrees  of  freedom,  under  some  reasonable  criterion  relating 
the  size  of  the  workspace  or  scale  of  each  individual  design.  This  comparison  is 
omitted  in  favour  of  applying  the  procedure  to  the  more  interesting  case  of  redundant 
manipulators  that  follows  in  the  next  section. 

8.7  Redundant  Manipulators 

Consider,  now,  a practical  example  in  which  the  volume  element  can  assist 
in  determining  the  efficacy  of  two  alternate  designs  for  a redundant  manipulator. 
The  manipulator  considered  is  the  Flight  Telerobotic  Servicer  Manipulator  System 
(FTSMS)  which  is  currently  being  developed  by  the  National  Aeronautics  and  Space 
Administration.  Two  alternate  designs  proposed  for  the  FTSMS  are  shown  in  figures 
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8.15  and  8.16.  Kinematic  models  for  these  manipulators  are  shown  in  figures  8.17 
and  8.18.  Their  constant  parameters  are  presented  in  Tables  8.2  and  8.3. 

The  mapping  of  a frame  J-  at  rest  with  respect  to  the  base  space  of  the  manip- 
ulator to  a frame  T at  rest  with  respect  to  the  end  effector  space  of  the  manipulator 
is  given  by  the  matrix 


S = n 


cos  0,- 
sin  0,- 
0 
0 


- cos  a, -,,•+!  sin  0,  sin  a,,,+1  sin  0,-  a,,,+1  cos  0,  ' 

cos  cos  0,-  — sin  cos  0,-  a1>t+1  sin  0, 

sinat>i+1  cos  a,it+1 

0 0 1 


This  matrix  is  given  explicitly  in  Appendix  B.  Now,  the  joint  angle  co-ordinate 
induced  tangent  vectors  are  related  to  the  Euler  co-ordinate  induced  tangent  vectors 

by 
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Figure  8.18.  Kinematic  Model  of  the  FTSMS  Design  B 


X01 

X* 

X*3 

X,4 

x*5 

x*6 

X,7 


d(<f>,6,i/),x,y,z) 
d(9i,  ...,07) 


7x6 


Using  the  substitutions  given  in  (8.20)  the  7 x 6 matrix  in  the  above  equation  is 
expressed  solely  in  terms  of  the  joint  angles  as 
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a12  = 

0 in 

£*12  = 

CO 

O 

0 

S2  = 8.25  in 

a 23  = 

9 in 

£*23  = 

90  0 

S3  = .00  in 

«34  = 

22  in 

£*34  = 

0 0 

1S4  — .00  in 

<*45  = 

3 in 

£*45  = 

O 

O 

S5  = 22.00  in 

a 56  — 

0 in 

£*56  = 

CO 

0 

0 

S$  = .00  in 

<*67  = 

4 in 

£*67  = 

0 

0 

Table  8.2.  Mechanism  Parameters  for  the  FTSMS  Design 

CZ12  = 

0 in 

£*12  = 

0 

0 

S2  = 8.25  in 

°23  = 

9 in 

£*  23  = 

0 

0 

o 

S3  = .00  in 

0*34  = 

22  in 

#34  = 

0 0 

*5*4  = .00  in 

a45  = 

22  in 

£*45  = 

0 0 

S5  = .00  in 

«56  = 

4 in 

£*56  = 

0 

0 

Se  = .00  in 

«67  = 

0 in 

£*67  = 

0 

0 

Table  8.3.  Mechanism  Parameters  for  the  FTSMS  Design  B 


J{Q 

(pis  + glz)2 

Since  the  seven  vectors  , . . . , X$7  exist  in  the  six  dimensional  tangent  space 
of  TeG,  they  must  be  linearly  dependent.  However,  any  six  of  these  vectors  form  a 
parallelepiped.  The  magnitude  of  the  volume  of  the  parallelepiped  formed  by  omitting 
X0,  is  given  by  applying  (8.19)  to  the  appropriate  six  vectors  and  yields 


sin  6 


d((f>,9,ip,x,y,z) 


\Ji\ 


(013  + 023  ) 2 ’ 


where  the  symbol  0,-  indicates  that  this  index  value  is  omitted  and  J,  represents 
the  6x6  minor  obtained  by  omitting  the  ith  row  of  the  7x6  matrix  J.  A more 
detailed  discussion  and  explicit  expressions  from  which  the  /,■  are  derived  are  given 


in  Appendix  B. 
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Following  the  procedure  adopted  for  the  redundant  planar  case  in  Section  8.4, 


Integrating  each  function  V;(0()  for  i = 1, . . . , 7,  with  respect  to  the  previously  fixed 
angle  0,-,  over  the  range  0 < 0,  < 2k,  and  dividing  by  2n  yields  an  average  value  of  the 


Finally,  the  motion  capability  of  the  redundant  manipulator  is  then  given  by 


Applying  (8.23)  to  the  two  designs  of  the  FTSMS  yields  the  numerical  results 
presented  in  Table  8.4.  The  equation  was  evaluated  using  a twelve  point  Gauss- 
Legendre  quadrature  algorithm.  The  details  of  the  calculation  are  in  Appendix  B 
Thus,  the  motion  capabilities  of  the  two  manipulators  are 

MdesignA  = 183334309.28477  ± 1.0155834348312  % error 

MdesignB  = 191517556.68370  i .69027903074872  % error  . 

The  motion  capability  of  design  B is  found  to  exceed  that  of  design  A by  at 
most  6.3  percent  and  by  at  least  2.7  percent.  One  concludes  that,  while  the  motion 
capability  of  both  designs  are  similar,  design  B is  superior. 


the  function  K'(0»)  represents  the  motion  capability  of  the  6 R manipulator  formed  by 
fixing  the  ith  joint.  It  is  given  by 


motion  capability  of  each  6 R manipulator  which  is  dependent  on  the  configuration 
of  each  redundant  joint.  This  yields 


(8.23) 
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Design  A 


Design  B 


M:  : 250844855.67039  ± 3325009.6937743 

M2  : 161115045.63591  ± 2494407.4716735 

M3  : 188508976.86723  ± 2378264.5364942 

M4  : 131584521.44226  ± 1122182.3118614 

M5  : 239486755.40225  ± 2355489.8951430 

M6  : 123321454.12099  ± 1239637.5821382 

M7  : 188478555.85433  ± 118398.63712385 


245647868.62494  ± 1543852.1261107 
156681912.80218  ± 1527313.4799180 
191422227.20226  ± 1276049.5328190 
138980526.32664  ± 250611.68582666 
206152193.55928  ± 198886.00864637 
156597816.70722  ± 1307732.0180155 
245140351.56339  ± 3149593.8865930 


Table  8.4.  Intermediate  Values  of  Motion  Capability  for  the  FTSMS  Designs 

It  is  of  more  interest  to  take  note  of  the  intermediate  values  M,  which  reveal 
more  specific  information  about  each  manipulator  configuration.  Af4  and  M6  of 
both  designs  are  the  smallest  intermediate  values  of  motion  capability.  These  values 
correspond  to  the  average  motion  capability  of  the  6R  manipulator  formed  by  fixing 
the  fourth  joint  or  sixth  joint.  The  small  values  indicate  that  the  fourth  and  sixth 
joints  are  the  most  important  joints  of  the  system  in  the  sense  explained  at  the  end 
of  Section  8.4.  It  is  interesting  to  note  that  the  joints  which  are  the  least  important 
are  the  first  and  fifth  joints  of  design  A and  the  first  and  seventh  joints  of  design  B. 
These  joints  have  the  common  trait  of  being  parallel  to  the  general  axis  or  length  of 
their  respective  designs  as  is  seen  by  Figures  8.15  and  8.16. 


CHAPTER  9 
CONCLUSIONS 


This  work  has  attempted  to  demonstrate  the  richness  and  power  inherent  in 
the  application  of  Lie  groups  to  the  field  of  robotics.  The  fundamental  aspects  of 
screw  theory  have  been  shown  to  arise  as  a natural  consequence  of  the  group  and 
differential  geometric  structure  of  the  Euclidean  group. 

The  Lie  group  approach  has  also  been  used  to  define  an  invariant  measure  with 
which  to  measure  the  concept  of  motion  capability  of  a robot  manipulator.  The 
application  of  this  concept  has  been  shown  to  be  global  in  scope,  addressable  to 
manipulators  of  arbitrary  design  and  thus,  independent  of  the  type  and  number  of 
joints,  and  the  parameterization  of  the  manipulator.  The  measure  has  been  shown  to 
predict  the  singularities  of  a manipulator.  When  aplied  to  redundant  manipulators, 
it  has  been  shown  to  quantify  the  effectiveness  of  the  redundancy  of  each  joint  of  the 
manipulator. 

The  measure  has  been  demonstrated  on  a typical  six-revolute  industrial  robot 
and  has  been  used  in  determining  the  efficacy  of  two  design  variations  of  the  space 
based  seven-revolute  Flight  Telerobotic  Servicer  Manipulator  System  currently  being 
studied  by  the  National  Aeronautics  and  Space  Administration. 

Further  applications  of  motion  capability  are  predicted  in  the  task  of  optimiza- 
tion of  manipulator  designs.  In  particular,  the  measure  appears  to  predict  the  well 
known  advantage  of  decoupling  of  the  rotational  and  translational  capabilities  of  a 
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manipulator.  Thus,  it  may  be  possible  to  determine  the  optimum  design  which  maxi- 
mizes motion  capability  for  six  and  seven-revolute  manipulators,  the  most  commonly 
encountered  classes  of  manipulators. 

The  future  holds  many  more  applications  of  Lie  groups  to  robotics.  The  theory 
of  the  kinematics  of  manipulators  is  currently  far  better  understood  than  the  dy- 
namics of  manipulators.  This  work  dealt  exclusively  with  the  tangent  bundle  which 
corresponds  to  the  study  of  the  kinematic  aspects  of  manipulators.  It  is  felt  that 
the  investigation  of  the  co-tangent  bundle  of  the  Euclidean  group  will  lead  to  break- 
throughs in  the  dynamical  apsects  of  manipulators  since  the  co-tangent  bundle  is 
related  to  forces  and  torques.  The  analogous  geometric  entity  is  called  a wrench  in 
screw  theory.  Unfortunately,  as  in  the  case  of  twists,  the  screw  theory  approach  pre- 
cludes information  about  the  finite  motions  from  which  the  forces  and  torques  and 
derived. 

The  human  arm  can  be  modeled  as  a seven-revolute  manipulator.  The  simple 
task  of  rotating  a crank,  or  sliding  a finger  along  the  edge  of  a table  for  example, 
are  very  difficult  to  emulate  in  robotics.  The  ability  to  control  position,  force  and 
velocity  simultaneously,  lie  at  the  heart  of  these  tasks. 

While  the  study  of  the  dynamics  of  manipulators  is  only  in  its  infacy,  it  is  felt 
that  the  Lie  group  approach  will  play  a critical  role. 


APPENDIX  A 

THE  GENERAL  ELECTRIC  P60  ROBOT 


The  mapping  of  a frame  T at  rest  with  respect  to  the  base  space  of  the  GE  P60 
robot  to  a frame  T at  rest  with  respect  to  the  end  effector  space  of  the  robot  is  given 
by  the  matrix 


cos  0,-  — cos  Qjtj+ 1 sin  0,-  sin  a<,,+i  sin  0,-  a,i>+1  cos  0, 

sin  0,-  cos  at-,t+1  cos  0,-  — sin  a,it+i  cos  0,  a;,i+i  sin  0, 

0 sin  at,t+i  cos  c*,,,+i  Si 

0 0 0 1 

where  each  matrix  in  the  product  represents  the  mapping  of  the  frame  identified  with 
the  ith  joint  into  the  ( i + l)</l  joint.  The  definition  of  this  mapping  via  the  parameters 
that  define  the  configuration  of  the  robot  are  given  in  Section  8.6,  Table  8.1.  It 
should  be  noted  that  the  choice  of  S\  is  dependent  on  the  parameterization  of  the 
base  space.  The  choice  of  S&,ae7,ae7  is  dependent  on  the  parameterization  of  the 
end  effector  space.  All  results  are  invariant  with  respect  to  these  choices,  hence  to 
simplify  calculations,  the  following  assignments  are  made: 

5i  = 0 
^6  = 0 
U67  = 0 

OlQ7  = 0 

With  these  values,  g is  given  explicitly  in  standard  seventy  three  column 
FORTRAN  code  with  the  following  symbolic  equivalents: 


i=6 

s = n 

i=i 
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The  matrix  elements  are  given  as 


g(i,  j)  = 9ij 


The  joint  angles  are  given  as 


thl  = 01 


th6  = 06 

The  link  lengths  are  given  as 


al2  = G12 


a67  = a67 

The  joint  offsets  are  given  as 


si  = Si 


s6  = Sq 

Thus  the  matrix  g is  given  as  follows: 
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g(l , 1)  = cos(thl)*(cos(th2)*(cos(th3)*(sin(th4)*sin(th6)+cos(th4)* 
Sc  cos (th5) *cos (th6) ) -sin(th3) * (sin(th4) *cos (th5) *cos (th6) -cos (th4 

& )*sin(th6)))-sin(th2)*(sin(th3)*(sin(th4)*sin(th6)+cos(th4)*cos 
& Cth5) *cos (th6) ) +cos (th3) * (sin(th4) *cos (th5) *cos (th6) -cos (th4) *s 
& in(th6) ) ) ) +sin(thl) *sin(th5) *cos (th6) 
g ( 1 , 2)  = cos (thl) * (cos (th2) * (cos (th3) * (sin(th4) *cos (th6) -cos (th4) * 
& cos(th5)*sin(th6))-sin(th3)*(-sin(th4)*cos(th5)*sin(th6)-cos(th 
Sc  4)*cos(th6) ))-sin(th2)*(cos(th3)*(-sin(th4)*cos(th5)*sin(th6)-c 
Sc  os(th4)*cos(th6))+sin(th3)*(sin(th4)*cos(th6)-cos(th4)*cos(th5) 
Sc  *sin(th6)) ) )-sin(thl)*sin(th5)*sin(th6) 
g(l ,3)  = cos(thl)*(cos(th2)*(cos(th3)*cos(th4)*sin(th5)-sin(th3)*s 
& in(th4)*sin(th5))-sin(th2)*(cos(th3)*sin(th4)*sin(th5)+sin(th3) 
& *cos (th4) *sin(th5) ) ) -sin (thl) *cos (th5) 
g(l ,4)  = cos(thl)*(-sin(th2)*(s5*sin(th3)*sin(th4)-s5*cos(th3)*cos 
& (th4) +a34*sin(th3) ) +cos (th2) * (s5*cos (th3) *sin(th4) +s5*sin(th3) * 

Sc  cos(th4)+a34*cos(th3))+a23*cos(th2) )+s4*sin(thl) 
g(2, 1)  = sin(thl)*(cos(th2)*(cos(th3)*(sin(th4)*sin(th6)+cos(th4)* 
& cos (th5) *cos (th6) ) -sin(th3) * (sin(th4) *cos (th5) *cos (th6) -cos (th4 
& )*sin(th6) ))-sin(th2)*(sin(th3)*(sin(th4)*sin(th6)+cos(th4)*cos 
& (th5) *cos (th6) ) +cos (th3) * (sin(th4) *cos (th5) *cos (th6) -cos (th4) *s 

& in(th6) )))-cos(thl)*sin(th5)*cos(th6) 

g(2,2)  = sin(thl)*(cos(th2)*(cos(th3)*(sin(th4)*cos(th6)-cos(th4)* 
& cos(th5)*sin(th6))-sin(th3)*(-sin(th4)*cos(th5)*sin(th6)-cos(th 
& 4)*cos(th6) ))-sin(th2)*(cos(th3)*(-sin(th4)*cos(th5)*sin(th6)-c 

& os (th4) *cos (th6) ) +sin(th3) * (sin(th4) *cos (th6) -cos (th4) *cos (th5) 

& *sin(th6))))+cos(thl)*sin(th5)*sin(th6) 

g(2,3)  = sin(thl)*(cos(th2)*(cos(th3)*cos(th4)*sin(th5)-sin(th3)*s 
& in(th4)*sin(th5))-sin(th2)*(cos(th3)*sin(th4)*sin(th5)+sin(th3) 

& *cos (th4) *sin(th5) ) ) +cos (thl) *cos (th5) 

g(2,4)  = sin(thl)*(-sin(th2)*(s5*sin(th3)*sin(th4)-s5*cos(th3)*cos 
& (th4)+a34*sin(th3))+cos(th2)*(s5*cos(th3)*sin(th4)+s5*sin(th3)* 

Sc  cos  (th4)  +a34*cos  (th3)  ) +a23*cos  (th2)  ) -s4*cos  (thl) 

g(3 » 1)  = cos(th2)*(sin(th3)*(sin(th4)*sin(th6)+cos(th4)*cos(th5)*c 

Sc  os (th6) ) +cos (th3) * (sin(th4) *cos (th5) *cos (th6) -cos (th4) *sin(th6) 

& ) ) +sin(th2) * (cos (th3) * (sin(th4) *sin(th6) +cos (th4) *cos (th5) *cos ( 

Sc  th6) ) -sin(th3)  * (sin(th4)  *cos  (th5)  *cos  (th6)  -cos  (th4)  *sin(th6) ) ) 

g(3  »2)  = sin(th2) * (cos (th3) * (sin(th4) *cos (th6) -cos (th4) *cos (th5) *s 
Sc  in(th6) )-sin(th3)*(-sin(th4)*cos (th5)*sin(th6) -cos (th4) *cos(th6 

Sc  )))+cos(th2)*(cos(th3)*(-sin(th4)*cos(th5)*sin(th6)-cos(th4)*co 

Sc  s (th6) ) +sin(th3)*(sin(th4) *cos (th6) -cos (th4) *cos (th5) *sin(th6) ) 
Sc  ) 

g(3.3)  = sin(th2)*(cos(th3)*cos(th4)*sin(th5)-sin(th3)*sin(th4)*si 
Sc  n(th5))+cos(th2)*(cos(th3)*sin(th4)*sin(th5)+sin(th3)*cos(th4)* 

& sin(th5)) 

g(3  >4)  = cos(th2)*(s5*sin(th3)*sin(th4)-s5*cos(th3)*cos(th4)+a34*s 
Sc  in(th3))+sin(th2)*(s5*cos(th3)*sin(th4)+s5*sin(th3)*cos(th4)+a3 
Sc  4*cos(th3))+a23*sin(th2) 
g(4,l)  = 0 
g(4,2)  = 0 
g(4 ,3)  = 0 
g(4,4)  = 1 
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In  a similar  fashion,  the  function  in  the  volume  element 

dv  = 1 ' 1 JMMMMMfle 

(#13  + 9 23) 

is  given  explicity  with  the  following  symbolic  substitutions: 


— Jji 

denom  = g\z  + 


With  the  above  symbolic  substitutions,  the  matrix  J and  the  denominator  are  given 
as  follows: 

J(1 , 1)  = (cos(thl)*(cos(th2)*(cos(th3)*cos(th4)*sin(th5)-sin(th3)* 

& sin(th4) *sin(th5) ) -sin(th2) * (cos (th3) *sin(th4) *sin(th5) +sin(th3 
& )*cos(th4)*sin(th5)))-sin(thl)*cos(th5))**2-(-sin(thl)*(cos(th2 
& )*(cos(th3)*cos(th4)*sin(th5)-sin(th3)*sin(th4)*sin(th5))-sin(t 
& h2) * (cos (th3) *sin(th4) *sin(th5) +sin(th3) *cos (th4) *sin(th5) ) ) -co 
& s (thl) *cos (th5) ) * (sin(thl) * (cos (th2) * (cos (th3) *cos (th4) *sin(th5 
& )-sin(th3)*sin(th4)*sin(th5))-sin(th2)*(cos(th3)*sin(th4)*sin(t 
& h5) +sin(th3) *cos (th4) *sin(th5) ) ) +cos (thl) *cos (th5) ) 

J(l,2)  = sin(thl)*(-sin(th2)*(cos(th3)*cos(th4)*sin(th5)-sin(th3)* 

& sin(th4)*sin(th5))-cos(th2)*(cos(th3)*sin(th4)*sin(th5)+sin(th3 
a )*cos(th4)*sin(th5)))*(cos(thl)*(cos(th2)*(cos(th3)*cos(th4)*si 
a n(th5)-sin(th3)*sin(th4)*sin(th5))-sin(th2)*(cos(th3)*sin(th4)* 
a sin(th5)+sin(th3)*cos(th4)*sin(th5)))-sin(thl)*cos(th5))-cos(th 
a D*(-sin(th2)*(cos(th3)*cos(th4)*sin(th5)-sin(th3)*sin(th4)*sin 
a (th5) ) -cos (th2) * (cos (th3) *sin(th4) *sin(th5) +sin(th3) *cos (th4) *s 
a in(th5)))*(sin(thl)*(cos(th2)*(cos(th3)*cos(th4)*sin(th5)-sin(t 
a h3)*sin(th4)*sin(th5))-sin(th2)*(cos(th3)*sin(th4)*sin(th5)+sin 
a (th3)*cos(th4)*sin(th5)))+cos(thl)*cos(th5)) 

J(l,3)  = sin(thl)*(cos(th2)*(-cos(th3)*sin(th4)*sin(th5)-sin(th3)* 
a cos (th4) *sin(th5) ) -sin(th2) *(cos (th3) *cos (th4) *sin(th5) -sin(th3 
a )*sin(th4)*sin(th5)))*(cos(thl)*(cos(th2)*(cos(th3)*cos(th4)*si 
a n(th5)-sin(th3)*sin(th4)*sin(th5))-sin(th2)*(cos(th3)*sin(th4)* 
a sin(th5)+sin(th3)*cos(th4)*sin(th5)))-sin(thl)*cos(th5))-cos(th 
a D*(cos(th2)*(-cos(th3)*sin(th4)*sin(th5)-sin(th3)*cos(th4)*sin 
a (th5))-sin(th2)*(cos(th3)*cos(th4)*sin(th5)-sin(th3)*sin(th4)*s 
a in(th5)))*(sin(thl)*(cos(th2)*(cos(th3)*cos(th4)*sin(th5)-sin(t 
a h3)*sin(th4)*sin(th5))-sin(th2)*(cos(th3)*sin(th4)*sin(th5)+sin 

a (th3) *cos (th4) *sin(th5) ) )+cos (thl) *cos (th5) ) 

J(1 >4)  = sin(thl)*(cos(th2)*(-cos(th3)*sin(th4)*sin(th5)-sin(th3)* 
a cos(th4)*sin(th5))-sin(th2)*(cos(th3)*cos(th4)*sin(th5)-sin(th3 
a )*sin(th4)*sin(th5)))*(cos(thl)*(cos(th2)*(cos(th3)*cos(th4)*si 
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ft  n(th5)-sin(th3)*sin(th4)*sin(th5))-sin(th2)*(cos(th3)*sin(th4)* 
ft  sin(th5)+sin(th3)*cos(th4)*sin(th5)) )-sin(thl)*cos(th5) )-cos(th 
ft  D*(cos(th2)*(-cos(th3)*sin(th4)*sin(th5)-sin(th3)*cos(th4)*sin 
ft  (th5) )-sin(th2)*(cos(th3)*cos(th4)*sin(th5)-sin(th3)*sin(th4)*s 
& in(th5lll*(sin(thl)*(cos(th2l*(cos(th3l*cos(th4)*sin(th5)-sin(t 
ft  h3)*sin(th4)*sin(th5) )-sin(th2)*(cos(th3)*sin(th4)*sin(th5)+sin 
ft  (th3)*cos(th4)*sin(th5)))+cos(thl)*cos(th5) ) 

J ( 1 ,5)  = (sin(thl)*(cos(th2)*(cos(th3)*cos(th4)*cos(th5)-sin(th3)* 
ft  sin(th4)*cos(th5))-sin(th2)*(cos(th3)*sin(th4)*cos(th5)+sin(th3 
& 1 *cos (th4) *cos (th5) ) ) -cos (thl) *sin(th5) ) * (cos (thl) * (cos (th2) * (c 

& os(th3)*cos(th4)*sin(th5)-sin(th3)*sin(th4)*sin(th5))-sin(th2)* 
& (cos(th3)*sin(th4)*sin(th5)+sin(th3)*cos(th4)*sin(th5)))-sin(th 
& l)*cos(th5))-(sin(thl)*sin(th5)+cos(thl)*(cos(th2)*(cos(th3)*co 
& s(th4)*cos(th5)-sin(th3)*sin(th4)*cos(th5))-sin(th2)*(cos(th3)* 
& sin(th4)*cos(th5)+sin(th3)*cos(th4)*cos(th5) )) )* (sin (thl)* (cos ( 
& th2)*(cos(th3)*cos(th4)*sin(th5)-sin(th3)*sin(th4)*sin(th5))-si 
& n(th2) * (cos (th3) *sin(th4) *sin(th5)+sin(th3) *cos (th4) *sin(th5) ) ) 
ft  +cos(thl)*cos(th5)) 

J(1 ,6)  = 0 
J(2,l)  = 0 

J(2,2)  = sin(th2)*(cos(th3)*sin(th4)*sin(th5)+sin(th3)*cos(th4)*si 
& n(th5))-cos(th2)*(cos(th3)*cos(th4)*sin(th5)-sin(th3)*sin(th4)* 
ft  sin(thS)) 

J(2,3)  = -cos(th2)*(cos(th3)*cos(th4)*sin(th5)-sin(th3)*sin(th4)*s 
& in(th5) )-sin(th2)*(-cos(th3)*sin(th4)*sin(th5)-sin(th3)*cos(th4 
ft  )*sin(th5)) 

J(2,4)  = -cos(th2)*(cos(th3)*cos(th4)*sin(th5)-sin(th3)*sin(th4)*s 
ft  in(th5))-sin(th2)*(-cos(th3)*sin(th4)*sin(th5)-sin(th3)*cos(th4 
ft  )*sin(th5)) 

J(2,5)  = -sin(th2)*(cos(th3)*cos(th4)*cos(th5)-sin(th3)*sin(th4)*c 
ft  os(th5))-cos(th2)*(cos(th3)*sin(th4)*cos(th5)+sin(th3)*cos(th4) 
ft  *cos(th5ll 
J(2,6)  = 0 
J(3,l)  = 0 

J(3,2)  = (cos(th2)*(cos(th3)*(sin(th4)*sin(th6)+cos(th4)*cos(th5)* 
ft  cos(th6))-sin(th3)*(sin(th4)*cos(th5)*cos(th6)-cos(th4)*sin(th6 
& )))-sin(th2)*(sin(th3)*(sin(th4)*sin(th6)+cos(th4)*cos(th5)*cos 
ft  (th6) )+cos(th3)*(sin(th4)*cos(th5)*cos(th6)-cos(th4)*sin(th6))) 
ft  )*(sin(th2)*(cos(th3)*(sin(th4)*cos(th6)-cos(th4)*cos(th5)*sin( 
ft  th6))-sin(th3)*(-sin(th4)*cos(th5)*sin(th6)-cos(th4)*cos(th6))) 
& +cos(th2)*(cos(th3)*(-sin(th4)*cos(th5)*sin(th6)-cos(th4)*cos(t 
ft  h6))+sin(th3)*(sin(th4)*cos(th6)-cos(th4)*cos(th5)*sin(th6)) li- 
ft (cos(th2)*(sin(th3l*(sin(th4l*sin(th6l+cos(th4l*cos(th5l*cos(th 

& 61 1+cos (th3l * (sin(th4l *cos (th5l*cos(th6l -cos (th4l *sin(th6l 1 1+si 

ft  n(th2l*(cos(th3l*(sin(th4)*sin(th6l+cos(th4!*cos(th5!*cos(th6)l 
ft  -sin(th3l*(sin(th4)*cos(th5l*cos(th6l-cos(th4l*sin(th6Hll*(cos 

ft  (th2l * (cos (th3l * (sin(th4l *cos (th6l -cos (th4l *cos (th5l *sin(th6l 1 - 

ft  sin(th3l*(-sin(th4l*cos(th5l*sin(th6l-cos(th4)*cos(th6lll-sin(t 
ft  h2)*(cos(th3)*(-sin(th4l*cos(th5)*sin(th6l-cos(th4)*cos(th6ll+s 
ft  in(th3l*(sin(th4)*cos(th6l-cos(th4l*cos(th5l*sin(th6)lll 
J(3,3)  = (sin(th2)*(-sin(th3l*(sin(th4l*sin(th6l+cos(th4l*cos(th5l 
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ft  *cos (th6) ) -cos (th3) * (sin(th4) *cos (th5) *cos(th6) -cos (th4) *sin(th 

ft  6) ))+cos(th2)*(cos(th3)*(sin(th4)*sin(th6)+cos(th4)*cos(th5)*co 
ft  s(th6) )-sin(th3)*(sin(th4)*cos(th5)*cos(th6)-cos(th4)*sin(th6)) 
ft  ))*(sin(th2)*(cos(th3)*(sin(th4)*cos(th6)-cos(th4)*cos(th5)*sin 
ft  (th6))-sin(th3)*(-sin(th4)*cos(th5)*sin(th6)-cos(th4)*cos(th6)) 
ft  )+cos(th2)*(cos(th3)*(-sin(th4)*cos(th5)*sin(th6)-cos(th4)*cos( 
ft  th6) ) +sin(th3) * (sin(th4) *cos (th6l -cos (th4) *cos (th5) *sin(th6) ) ) ) 

ft  -(cos(th2)*(sin(th3l*(sin(th4)*sin(th6)+cos(th4)*cos(th5)*cos(t 
ft  h6) )+cos(th3)*(sin(th4)*cos(th5)*cos(th6)-cos(th4)*sin(th6) ) )+s 
ft  in(th2) * (cos (th3) * (sin(th4) *sin(th6l +cos (th4) *cos (th5) *cos (th6) 
ft  )-sin(th3)*(sin(th4)*cos(th5)*cos(th6)-cos(th4)*sin(th6))))*(co 
& s (th2) * (cos (th3) * (sin(th4) *cos (th6) -cos (th4) *cos (th5) *sin(th6) ) 
& -sin(th3)*(-sin(th4)*cos(th5)*sin(th6)-cos(th4)*cos(th6)))+sin( 
& th2)*(-cos(th3)*(-sin(th4)*cos(th5)*sin(th6)-cos(th4)*cos(th6) ) 
& -sin(th3) * (sin(th4) *cos (th6) -cos (th4) *cos (th5) *sin(th6) ) ) ) 
J(3,4)  = (sin(th2)*(cos(th3)*(cos(th4)*sin(th6)-sin(th4)*cos(th5)* 
& cos(th6) )-sin(th3)*(sin(th4)*sin(th6)+cos(th4)*cos(th5)*cos(th6 
& )))+cos(th2)*(cos(th3)*(sin(th4)*sin(th6)+cos(th4)*cos(th5)*cos 
& (th6) )+sin(th3)*(cos(th4)*sin(th6)-sin(th4)*cos(th5)*cos(th6) )) 

& )*(sin(th2)*(cos(th3)*(sin(th4)*cos(th6)-cos(th4)*cos(th5)*sin( 
& th6))-sin(th3)*(-sin(th4)*cos(th5)*sin(th6)-cos(th4)*cos(th6))) 
& +cos(th2)*(cos(th3)*(-sin(th4l*cos(th5l*sin(th6l-cos(th4)*cos(t 
& h6))+sin(th3)*(sin(th4)*cos(th6)-cos(th4)*cos(th5)*sin(th6)) li- 
ft (cos(th2l*(sin(th3)*(sin(th4)*sin(th6l+cos(th4l*cos(th5l*cos(th 
ft  6))+cos(th3l*(sin(th4l*cos(th5)*cos(th6l-cos(th4l*sin(th6ll)+si 
ft  n(th2)*(cos(th3)*(sin(th4l*sin(th6l+cos(th4!*cos(th5l*cos(th6l! 
ft  -Sin(th3l*(sin(th4)*cos(th5l*cos(th6l-cos(th4l*sin(th6llll*(cos 
ft  (th2) * (sin(th3) * (sin(th4) *cos (th5l *sin(th6l+cos (th4l *cos (th6l 1+ 
ft  cos (th3l * (sin(th4) *cos (th6l -cos (th4l *cos (th5l *sin(th6l 1 1 +sin(th 
ft  2l*(cos(th3)*(sin(th4!*cos(th5)*sin(th6)+cos(th4l*cos(th6ll-sin 
ft  (th3) * (sin(th4) *cos (th6l -cos(th4) *cos (th5) *sin(th6l 1 1 1 
J(3,5l  = (sin(th2l*(sin(th3l*sin(th4)*sin(th5)*cos(th6l-cos(th3l*c 
ft  os(th4l*sin(th5l*cos(th6ll+cos(th2l*(-cos(th3l*sin(th4)*sin(th5 
& )*cos(th6l-sin(th3l*cos(th4l*sin(th5l*cos(th6)ll*(sin(th2l*(cos 

ft  (th3l * (sin(th4) *cos (th6l -cos (th4l *cos (th5l *sin(th6) 1 -sin(th3l * ( 
ft  -sin(th4l *cos (th5) *sin(th6l -cos (th4l *cos (th6l 1 ) +cos (th2l * (cos (t 

ft  h3)*(-sin(th4)*cos(th5l*sin(th6l-cos(th4l*cos(th6l!+sin(th3l*(s 
ft  in(th4)*cos(th6)-cos(th4l*cos(th5)*sin(th6)lll-(sin(th2l*(cos(t 
ft  h3l*cos(th4l*sin(th5)*sin(th6l-sin(th3l*sin(th4l*sin(th5l*sin(t 

ft  h6l 1+cos (th2) * (cos (th3) *sin(th4l *sin(th5l *sin(th6l+sin(th3l *cos 

ft  (th4l*sin(th5)*sin(th6!l)*(cos(th2)*(sin(th3)*(sin(th4l*sin(th6 

ft  1+cos (th4l *cos (th5l*cos (th6l 1+cos (th3l * (sin(th4l *cos (th5l *cos (t 

ft  h6l -cos (th4l *sin(th6l 1 l+sin(th2) * (cos (th3l* (sin(th4l *sin(th6l+c 

ft  os(th4l*cos(th5l*cos(th6ll-sin(th3l*(sin(th4l*cos(th5l*cos(th6l 
ft  -cos(th4l*sin(th6))H 

J(3,6)  = (sin(th2l*(cos(th3l*(sin(th4l*cos(th6l-cos(th4)*cos(th5)* 
ft  sin(th6)l-sin(th3)*(-sin(th4l*cos(th5)*sin(th6l-cos(th4l*cos(th 
& 6ll)+cos(th2l*(cos(th3)*(-sin(th4)*cos(th5)*sin(th6l-cos(th4l*c 
& os(th6)l+sin(th3l*(sin(th4)*cos(th6l-cos(th4)*cos(th5l*sin(th6l 
ft  )ll**2-(cos(th2)*(sin(th3l*(-sin(th4l*sin(th6l-cos(th4l*cos(th5 
ft  )*cos(th6l 1+cos (th3l* (cos (th4l*sin(th6l-sin(th4l*cos(th5l*cos(t 
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& h6) ) ) +sin(th2) * (cos (th3) * (-sin(th4) *sin(th6) -cos (th4) *cos (th5) * 

& cos (th6) ) -sin(th3) * (cos (th4) *sin(th6) -sin(th4) *cos (th5) *cos (th6 

& ))))*(cos(th2)*(sin(th3)*(sin(th4)*sin(th6)+cos(th4)*cos(th5)*c 

& os (th6) ) +cos (th3) * (sin(th4) *cos (th5) *cos (th6) -cos (th4) *sin(th6) 
& ) ) +sin(th2) * (cos (th3) * (sin(th4) *sin(th6) +cos (th4) *cos (th5) *cos ( 

& th6))-sin(th3)*(sin(th4)*cos(th5)*cos(th6)-cos(th4)*sin(th6)))) 
J(4, 1)  = s4*cos(thl)-sin(thl)*(-sin(th2)*(s5*sin(th3)*sin(th4)-s5* 
& cos(th3)*cos(th4)+a34*sin(th3))+cos(th2)*(s5*cos(th3)*sin(th4)+ 
& s5*sin(th3)*cos(th4)+a34*cos(th3) )+a23*cos(th2)) 

J(4 ,2)  = cos(thl)*(-cos(th2)*(s5*sin(th3)*sin(th4)-s5*cos(th3)*cos 
& (th4)+a34*sin(th3) )-sin(th2)*(s5*cos(th3)*sin(th4)+s5*sin(th3)* 

& cos (th4) +a34*cos (th3) ) -a23*sin(th2) ) 

J(4,3)  = cos(thl)*(cos(th2)*(-s5*sin(th3)*sin(th4)+s5*cos(th3)*cos 
& (th4)-a34*sin(th3) )-sin(th2)*(s5*cos(th3)*sin(th4)+s5*sin(th3)* 

& cos(th4)+a34*cos(th3))) 

J(4,4)  = cos(thl)*(cos(th2)*(s5*cos(th3)*cos(th4)-s5*sin(th3)*sin( 
& th4))-sin(th2)*(s5*cos(th3)*sin(th4)+s5*sin(th3)*cos(th4)) ) 
J(4,5)  = 0 
J(4,6)  = 0 

J(5, 1)  = cos(thl)*(-sin(th2)*(s5*sin(th3)*sin(th4)-s5*cos(th3)*cos 
& (th4)+a34*sin(th3))+cos(th2)*(s5*cos(th3)*sin(th4)+s5*sin(th3)* 

& cos (th4) +a34*cos (th3) )+a23*cos (th2) )+s4*sin(thl) 

J(5,2)  = sin(thl)*(-cos(th2)*(s5*sin(th3)*sin(th4)-s5*cos(th3)*cos 
& (th4)+a34*sin(th3) )-sin(th2)*(s5*cos(th3)*sin(th4)+s5*sin(th3) * 

& cos (th4) +a34*cos (th3) ) -a23*sin(th2) ) 

J(5,3)  = sin(thl)*(cos(th2)*(-s5*sin(th3)*sin(th4)+s5*cos(th3)*cos 
& (th4)-a34*sin(th3) )-sin(th2)*(s5*cos(th3)*sin(th4)+s5*sin(th3)* 

& cos(th4)+a34*cos(th3))) 

J(5,4)  = sin(thi)*(cos(th2)*(s5*cos(th3)*cos(th4)-s5*sin(th3)*sin( 
& th4) )-sin(th2)*(s5*cos(th3)*sin(th4)+s5*sin(th3)*cos(th4))) 
J(5,5)  = 0 
J(5,6)  = 0 
J(6 , 1)  = 0 

•1(6,2)  = -sin(th2)*(s5*sin(th3)*sin(th4)-s5*cos(th3)*cos(th4)+a34* 
& sin(th3))+cos(th2)*(s5*cos(th3)*sin(th4)+s5*sin(th3)*cos(th4)+a 
& 34*cos (th3) )+a23*cos (th2) 

J(6 ,3)  = sin(th2)*(-s5*sin(th3)*sin(th4)+s5*cos(th3)*cos(th4)-a34* 
& sin(th3))+cos(th2)*(s5*cos(th3)*sin(th4)+s5*sin(th3)*cos(th4)+a 
& 34*cos(th3)) 

J(6»4)  = sin(th2)*(s5*cos(th3)*cos(th4)-s5*sin(th3)*sin(th4))+cos( 

& th2)* (s5*cos (th3) *sin(th4)+s5*sin(th3) *cos(th4) ) 

J(6,5)  = 0 
J(6,6)  = 0 

denom  = (sin(thl)*(cos(th2)=Kcos(th3)*cos(th4)*sin(th5)-sin(th3)* 
& sin(th4) *sin(th5) )-sin(th2) *(cos(th3) *sin(th4)*sin(th5)+sin(th3 
& ) *cos (th4) *sin(th5) ) ) +cos (thl) *cos (th5) ) **2+ (cos (thl ) * (cos (th2) 

& *(cos(th3)*cos(th4)*sin(th5)-sin(th3)*sin(th4)*sin(th5))-sin(th 
& 2)*(cos(th3)*sin(th4)*sin(th5)+sin(th3)*cos(th4)*sin(th5)))-sin 

& (thl)*cos(th5))**2 


APPENDIX  B 

THE  FLIGHT  TELEROBOTIC  SERVICER  MANIPULATOR  SYSTEM 


The  mapping  of  a frame  T at  rest  with  respect  to  the  base  space  of  the  FTSMS 
designs  to  a frame  T at  rest  with  respect  to  the  end  effector  space  of  the  manipulators 
is  given  by  the  matrix 

cos  Oi  — cos  sin  0,-  sin  a,t,+1  sin  0,  a;,;+i  cos  0, 

sin  0,-  cos  a, -,1+1  cos  0,  — sin  a,it+1  cos  0,-  a,,,+i  sin  0,- 

0 sinai<i+1  cos  a,-,i+i  S,  ’ 

0 0 0 1 

where  each  matrix  in  the  product  represents  the  mapping  of  the  frame  identified  with 
the  ith  joint  into  the  ( i + l)t/l  joint.  The  definition  of  this  mapping  via  the  parameters 
which  define  the  configuration  of  the  manipulators  are  given  in  Section  8.7,  Tables  8.2 
and  8.3.  It  is  noted  that  the  choice  of  S\  is  dependent  on  the  parameterization  of  the 
base  space,  and  the  choice  of  5Y , aj$,  and  at78  is  dependent  on  the  parameterization  of 
the  end  effector  space.  All  results  are  invariant  with  respect  to  these  choices.  Thus, 
to  simplify  calculations  the  following  assignments  are  made: 

Si  = 0 
S7  = 0 

a78  = 0 

«78  = 0 

With  these  values,  g is  given  in  standard  seventy  three  column  FORTRAN  code 
with  the  following  symbolic  equivalents: 


1 

g = n 
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The  matrix  elements  are 


9H 


The  joint  angles  are 


0i 


06 


The  link  lengths  are 


a 12 


^78 


The  joint  offsets  are 


S7 


= g(iJ) 

= th(l) 
= th(6) 

= al2 
= a78 

= si 
= s7 


Thus,  the  matrix  g for  the  FTSMS  Design  A is  given  as  follows: 
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g(l , 1)  = cos(th(l) )*(cos(th(2) )*(cos(th(3) )*(cos(th(4) )*(sin(th(5) 
& )*sin(th(7))+cos(th(5))*cos(th(6))*cos(th(7)))+sin(th(4))*sin(t 
& h(6))*cos(th(7)))-sin(th(3))*(sin(th(4))*(sin(th(5))*sin(th(7)) 
& +cos(th(5))*cos(th(6))*cos(th(7)))-cos(th(4))*sin(th(6))*cos(th 
a (7))))+sin(th(2))*(sin(th(5))*cos(th(6))*cos(th(7))-cos(th(5))* 
& sin(th(7))))+sin(thd))*(cos(th(3))*(sin(th(4))*(sin(th(5))*sin 
& (th(7))+cos(th(5))*cos(th(6))*cos(th(7)))-cos(th(4))*sin(th(6)) 
& *cos(th(7)))+sin(th(3))*(cos(th(4))*(sin(th(5))*sin(th(7))+cos( 
& th(5))*cos(th(6))*cos(th(7)))+sin(th(4))*sin(th(6))*cos(th(7))) 
& ) 

g(l ,2)  = cos(th(i))*(cos(th(2) )*(cos(th(3))*(cos(th(4) )*(sin(th(5) 
& )*cos(th(7))-cos(th(5))*cos(th(6))*sin(th(7)))-sin(th(4))*sin(t 
& h(6))*sin(th(7)))-sin(th(3))*(sin(th(4))*(sin(th(5))*cos(th(7)) 
& -cos(th(5))*cos(th(6))*sin(th(7)))+cos(th(4))*sin(th(6))*sin(th 
& (7))))+sin(th(2))*(-sin(th(5))*cos(th(6))*sin(th(7))-cos(th(5)) 
& *cos(th(7) ) ) )+sin(th(l))*(cos(th(3) )*(sin(th(4) )*(sin(th(5))*co 
& s(th(7))-cos(th(5))*cos(th(6))*sin(th(7)))+cos(th(4))*sin(th(6) 
& )*sin(th(7) ) )+sin(th(3))*(cos(th(4))*(sin(th(5) )*cos(th(7))-cos 
a (th(5) )*cos(th(6))*sin(th(7) ) )-sin(th(4) )*sin(th(6) )*sin(th(7) ) 
& )) 

g(l ,3)  = cos(th(l) )*(cos(th(2) )*(cos(th(3) )*(cos(th(4) )*cos(th(5)) 
& *sin(th(6))-sin(th(4))*cos(th(6)))-sin(th(3))*(sin(th(4))*cos(t 
& h(5))*sin(th(6))+cos(th(4))*cos(th(6))))+sin(th(2))*sin(th(5))* 
& sin(th(6)))+sin(thd))*(cos(th(3))*(sin(th(4))*cos(th(5))*sin(t 
& h(6))+cos(th(4))*cos(th(6)))+sin(th(3))*(cos(th(4))*cos(th(5))* 
& sin(th(6) )-sin(th(4) )*cos(th(6) ) ) ) 

g(l,4)  = cos(thd))*(cos(th(2))*(cos(th(3))*(sin(th(4))*(s5+sin(th 
& (6))*a67)+cos(th(4))*cos(th(5))*cos(th(6))*a67+cos(th(4))*a45)- 
& sin(th(3))*(-cos(th(4))*(s5+sin(th(6))*a67)+sin(th(4))*cos(th(5 
& ))*cos(th(6))*a67+sin(th(4))*a45)+cos(th(3))*a34)+sin(th(2))*si 
& n(th(5))*cos(th(6))*a67+cos(th(2))*a23)+sin(thd))*(sin(th(3))* 
& (sin(th(4))*(s5+sin(th(6))*a67)+cos(th(4))*cos(th(5))*cos(th(6) 
& )*a67+cos(th(4))*a45)+cos(th(3))*(-cos(th(4))*(s5+sin(th(6))*a6 
& 7)+sin(th(4))*cos(th(5))*cos(th(6))*a67+sin(th(4))*a45)+s2+sin( 

& th(3) ) *a34) 

g(2,l)  = sin(thd)  )*(cos(th(2))*(cos(th(3))*(cos(th(4)  )*(sin(th(5) 
& )*sin(th(7))+cos(th(5))*cos(th(6))*cos(th(7)))+sin(th(4))*sin(t 
& h(6))*cos(th(7)))-sin(th(3))*(sin(th(4))*(sin(th(5))*sin(th(7)) 
& +cos(th(5))*cos(th(6))*cos(th(7)))-cos(th(4))*sin(th(6))*cos(th 
& (7))))+sin(th(2))*(sin(th(5))*cos(th(6))*cos(th(7))-cos(th(5))* 
& sin(th(7))))-cos(th(l))*(cos(th(3))*(sin(th(4))*(sin(th(5))*sin 
& (th(7))+cos(th(5))*cos(th(6))*cos(th(7)))-cos(th(4))*sin(th(6)) 
& *cos(th(7)))+sin(th(3))*(cos(th(4))*(sin(th(5))*sin(th(7))+cos( 
a th(5))*cos(th(6))*cos(th(7)))+sin(th(4))*sin(th(6))*cos(th(7))) 
a ) 

g(2»2)  = sin(th(l))*(cos(th(2))*(cos(th(3))*(cos(th(4))*(sin(th(5) 
a )*cos(th(7))-cos(th(5))*cos(th(6))*sin(th(7)))-sin(th(4))*sin(t 
a h(6))*sin(th(7)))-sin(th(3))*(sin(th(4))*(sin(th(5))*cos(th(7)) 
a -cos(th(5) )*cos(th(6) )*sin(th(7)))+cos(th(4))*sin(th(6))*sin(th 
& (7))))+sin(th(2))*(-sin(th(5))*cos(th(6))*sin(th(7))-cos(th(5)) 
a *cos(th(7))))-cos(thd))*(cos(th(3))*(sin(th(4))*(sin(th(5))*co 
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& s(th(7))-cos(th(5))*cos(th(6))*sin(th(7)))+cos(th(4))*sin(th(6) 

& )*sin(th(7)))+sin(th(3))*(cos(th(4))*(sin(th(5))*cos(th(7))-cos 

ft  (th(5))*cos(th(6))*sin(th(7)))-sin(th(4))*sin(th(6))*sin(th(7)) 
& )) 

g(2,3)  = sin(th(l))*(cos(th(2))*(cos(th(3))*(cos(th(4))*cos(th(5)) 
& *sin(th(6))-sin(th(4))*cos(th(6)))-sin(th(3))*(sin(th(4))*cos(t 

& h(5) )*sin(th(6) )+cos(th(4) )*cos(th(6))) )+sin(th(2))*sin(th(5))* 

& sin(th(6)))-cos(th(l))*(cos(th(3))*(sin(th(4))*cos(th(5))*sin(t 

& h(6))+cos(th(4))*cos(th(6)))+sin(th(3))*(cos(th(4))*cos(th(5))* 

& sin(th(6) )-sin(th(4) )*cos(th(6) ) ) ) 
g(2,4)  = sin(th(l))*(cos(th(2))*(cos(th(3))*(sin(th(4) )*(s5+sin(th 
ft  (6))*a67)+cos(th(4))*cos(th(5))*cos(th(6))*a67+cos(th(4))*a45)- 
& sin(th(3))*(-cos(th(4))*(s5+sin(th(6))*a67)+sin(th(4))*cos(th(5 

ft  ))*cos(th(6))*a67+sin(th(4))*a45)+cos(th(3))*a34)+sin(th(2))*si 
ft  n(th(5))*cos(th(6))*a67+cos(th(2))*a23)-cos(th(l))*(sin(th(3))* 
ft  (sin(th(4))*(s5+sin(th(6))*a67)+cos(th(4))*cos(th(5))*cos(th(6) 
ft  )*a67+cos(th(4))*a45)+cos(th(3))*(-cos(th(4))*(s5+sin(th(6))*a6 
ft  7)+sin(th(4) )*cos(th(5))*cos(th(6) )*a67+sin(th(4))*a45)+s2+sin( 
ft  th(3))*a34) 

g(3, 1)  = sin(th(2))*(cos(th(3))*(cos(th(4))*(sin(th(5))*sin(th(7)) 
& +cos(th(5))*cos(th(6))*cos(th(7)))+sin(th(4))*sin(th(6))*cos(th 

ft  (7)))-sin(th(3))*(sin(th(4))*(sin(th(5))*sin(th(7))+cos(th(5))* 
ft  cos(th(6))*cos(th(7)))-cos(th(4))*sin(th(6))*cos(th(7))))-cos(t 
ft  h(2))*(sin(th(5))*cos(th(6))*cos(th(7))-cos(th(5))*sin(th(7))) 
g(3,2)  = sin(th(2))*(cos(th(3))*(cos(th(4))*(sin(th(5))*cos(th(7)) 
ft  -cos(th(5))*cos (th(6) )*sin(th(7) ) )-sin(th(4) )*sin(th(6) )*sin(th 
ft  (7)))-sin(th(3))*(sin(th(4))*(sin(th(5))*cos(th(7))-cos(th(5))* 
ft  cos(th(6))*sin(th(7)))+cos(th(4))*sin(th(6))*sin(th(7))))-cos(t 
ft  h(2))*(-sin(th(5))*cos(th(6))*sin(th(7))-cos(th(5))*cos(th(7))) 
g(3,3)  = sin(th(2))*(cos(th(3))*(cos(th(4))*cos(th(5))*sin(th(6))- 
& sin(th(4))*cos(th(6)))-sin(th(3))*(sin(th(4))*cos(th(5))*sin(th 

ft  (6))+cos(th(4))*cos(th(6))))-cos(th(2))*sin(th(5))*sin(th(6)) 
g(3,4)  = sin(th(2))*(cos(th(3))*(sin(th(4))*(s5+sin(th(6))*a67)+co 
ft  s(th(4))*cos(th(5))*cos(th(6))*a67+cos(th(4))*a45)-sin(th(3))*( 
ft  -cos(th(4))*(s5+sin(th(6))*a67)+sin(th(4))*cos(th(5))*cos(th(6) 
ft  )*a67+sin(th(4))*a45)+cos(th(3))*a34)+sll-cos(th(2))*sin(th(5)) 
ft  *cos(th(6))*a67+sin(th(2))*a23 
g(4 , 1)  = 0 
g(4,2)  = 0 
g(4,3)  = 0 
g(4 ,4)  = 1 
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Also,  the  matrix  g for  the  FTSMS  Design  B is  given  as  follows: 

g(l,l)  = cos(th(l))*(cos(th(2))*(cos(th(3))*(cos(th(4))*(sin(th(5) 
Sc  )*sin(th(7))+cos(th(5))*cos(th(6))*cos(th(7)))-sin(th(4))*(sin( 
& th(5))*cos(th(6))*cos(th(7))-cos(th(5))*sin(th(7))))-sin(th(3)) 

& *(sin(th(4) )*(sin(th(5))*sin(th(7))+cos(th(5))*cos(th(6) )*cos(t 

& h(7) ) )+cos(th(4) )*(sin(th(5))*cos(th(6) )*cos(th(7))-cos(th(5) )* 

Sc  sin(th(7)))))+sin(th(2))*sin(th(6))*cos(th(7)))+sin(th(l))*(cos 
& (th(3))*(sin(th(4))*(sin(th(5))*sin(th(7))+cos(th(5))*cos(th(6) 

Sc  )*cos(th(7)))+cos(th(4))*(sin(th(5))*cos(th(6))*cos(th(7))-cos( 
Sc  th(5) )*sin(th(7) ) ))+sin(th(3))*(cos(th(4) )*(sin(th(5) )*sin(th(7 
& ))+cos(th(5))*cos(th(6))*cos(th(7)))-sin(th(4))*(sin(th(5))*cos 

& (th(6))*cos(th(7))-cos(th(5))*sin(th(7))))) 

g ( 1 ,2)  = cos(th(l))*(cos(th(2))*(cos(th(3))*(cos(th(4))*(sin(th(5) 
Sc  )*cos(th(7) )-cos(th(5) )*cos(th(6))*sin(th(7)))-sin(th(4))*(-sin 
Sc  (th(5) )*cos(th(6) )*sin(th(7) )-cos(th(5))*cos(th(7) )))-sin(th(3) 
Sc  )*(cos(th(4))*(-sin(th(5))*cos(th(6))*sin(th(7))-cos(th(5))*cos 
Sc  (th(7) ) )+sin(th(4) )*(sin(th(5))*cos(th(7) )-cos(th(5))*cos(th(6) 
Sc  )*sin(th(7)))))-sin(th(2))*sin(th(6))*sin(th(7)))+sin(th(l))*(s 
Sc  in(th(3))*(cos(th(4))*(sin(th(5))*cos(th(7))-cos(th(5))*cos(th( 
Sc  6) )*sin(th(7) ))-sin(th(4))*(-sin(th(5) )*cos(th(6))*sin(th(7))-c 
Sc  os(th(5))*cos(th(7))))+cos(th(3))*(cos(th(4))*(-sin(th(5))*cos( 
Sc  th(6))*sin(th(7))-cos(th(5))*cos(th(7)))+sin(th(4))*(sin(th(5)) 
Sc  *cos(th(7))-cos(th(5))*cos(th(6))*sin(th(7))))) 
g ( 1 ,3)  = cos(th(l))*(cos(th(2))*(cos(th(3))*(cos(th(4))*cos(th(5)) 
Sc  *sin(th(6))-sin(th(4))*sin(th(5))*sin(th(6)))-sin(th(3))*(cos(t 
Sc  h(4))*sin(th(5))*sin(th(6))+sin(th(4))*cos(th(5))*sin(th(6)) ))- 
Sc  sin(th(2))*cos(th(6)))+sin(th(l))*(sin(th(3))*(cos(th(4))*cos(t 
Sc  h(5))*sin(th(6) )-sin(th(4))*sin(th(5))*sin(th(6)) )+cos(th(3))*( 
Sc  cos(th(4))*sin(th(5))*sin(th(6))+sin(th(4))*cos(th(5))*sin(th(6 
Sc  )))) 

g(l,4)  = sin(th(l))*(s2+sin(th(3))*(-sin(th(4))*sin(th(5))*a56+cos 
Sc  (th(4))*cos(th(5))*a56+cos(th(4))*a45)+cos(th(3))*(cos(th(4))*s 
Sc  in(th(5))*a56+sin(th(4))*cos(th(5))*a56+sin(th(4))*a45)+sin(th( 
Sc  3) )*a34)+cos(th(l))*(cos(th(2))*(cos(th(3) )*(-sin(th(4) )*sin(th 
& (5) ) *a56+cos (th(4) ) *cos (th(5) )*a56+cos (th(4) )*a45) -sin(th(3) ) *( 

Sc  cos(th(4))*sin(th(5))*a56+sin(th(4))*cos(th(5))*a56+sin(th(4))* 
Sc  a45)+cos(th(3)  )*a34)+cos(th(2))*a23) 

g(2,l)  = sin(th(l) )*(cos(th(2) )*(cos(th(3) )*(cos(th(4))*(sin(th(5) 
Sc  )*sin(th(7))+cos(th(5))*cos(th(6))*cos(th(7)))-sin(th(4))*(sin( 
& th(5))*cos(th(6))*cos(th(7))-cos(th(5))*sin(th(7))))-sin(th(3)) 

Sc  *(sin(th(4))*(sin(th(5))*sin(th(7))+cos(th(5))*cos(th(6))*cos(t 
& h(7)))+cos(th(4))*(sin(th(5))*cos(th(6))*cos(th(7))-cos(th(5))* 

Sc  sin(th(7)))))+sin(th(2))*sin(th(6))*cos(th(7)))-cos(th(l))*(cos 
& (th(3))*(sin(th(4))*(sin(th(5))*sin(th(7) )+cos(th(5))*cos(th(6) 

Sc  )*cos(th(7)))+cos(th(4))*(sin(th(5))*cos(th(6))*cos(th(7))-cos( 
Sc  th(5))*sin(th(7))))+sin(th(3))*(cos(th(4))*(sin(th(5))*sin(th(7 
Sc  ))+cos(th(5))*cos(th(6))*cos(th(7)))-sin(th(4))*(sin(th(5))*cos 
Sc  (th(6))*cos(th(7))-cos(th(5))*sin(th(7))))) 
g(2.2)  = sin(th(l))*(cos(th(2))*(cos(th(3))*(cos(th(4) )*(sin(th(5) 
Sc  )*cos(th(7))-cos(th(5))*cos(th(6) )*sin(th(7) ))-sin(th(4))*(-sin 
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Sc  (th(5))*cos(th(6))*sin(th(7))-cos(th(5))*cos(th(7))))-sin(th(3) 
Sc  )*(cos(th(4))*(-sin(th(5) )*cos(th(6))*sin(th(7))-cos(th(5) )*cos 
Sc  (th(7)))+sin(th(4))*(sin(th(5))*cos(th(7))-cos(th(5))*cos(th(6) 
& ) *sin(th(7) ) ) ) ) -sin(th(2) ) *sin(th(6) )*sin(th(7) ) )-cos(th(l) ) *(s 

& in(th(3))*(cos(th(4) )*(sin(th(5))*cos(th(7) )-cos(th(5))*cos(th( 

& 6))*sin(th(7)))-sin(th(4))*(-sin(th(5))*cos(th(6))*sin(th(7))-c 

Sc  os(th(5))*cos(th(7))))+cos(th(3))*(cos(th(4))*(-sin(th(5))*cos( 
Sc  th(6))*sin(th(7))-cos(th(5))*cos(th(7)))+sin(th(4))*(sin(th(5)) 
Sc  *cos(th(7))-cos(th(5))*cos(th(6))*sin(th(7))))) 
g(2,3)  = sin(th(l))*(cos(th(2))*(cos(th(3))*(cos(th(4))*cos(th(5)) 
Sc  *sin(th(6))-sin(th(4))*sin(th(5))*sin(th(6)))-sin(th(3))*(cos(t 
Sc  h(4))*sin(th(5))*sin(th(6))+sin(th(4))*cos(th(5))*sin(th(6))))- 
Sc  sin(th(2))*cos(th(6)))-cos(th(l))*(sin(th(3))*(cos(th(4))*cos(t 
Sc  h(5))*sin(th(6))-sin(th(4))*sin(th(5))*sin(th(6)))+cos(th(3))*( 
Sc  cos(th(4))*sin(th(5))*sin(th(6))+sin(th(4))*cos(th(5))*sin(th(6 
& )))) 

g(2,4)  = sin(th(l))*(cos(th(2))*(cos(th(3))*(-sin(th(4))*sin(th(5) 
Sc  )*a56+cos(th(4))*cos(th(5))*a56+cos(th(4))*a45)-sin(th(3))*(cos 
Sc  (th(4)  )*sin(th(5)  ) *a56+sin(th(4) )*cos(th(5) )*a56+sin(th(4) )*a45 
Sc  )+cos(th(3))*a34)+cos(th(2))*a23)-cos(th(l))*(s2+sin(th(3))*(-s 
Sc  in(th(4))*sin(th(5))*a56+cos(th(4))*cos(th(5))*a56+cos(th(4))*a 
Sc  45)+cos(th(3))*(cos(th(4))*sin(th(5))*a56+sin(th(4))*cos(th(5)) 
Sc  *a56+sin(th(4))*a45)+sin(th(3))*a34) 

g(3,l)  = sin(th(2))*(cos(th(3))*(cos(th(4))*(sin(th(5))*sin(th(7)) 
Sc  +cos(th(5))*cos(th(6))*cos(th(7)))-sin(th(4))*(sin(th(5))*cos(t 
& h(6))*cos(th(7))-cos(th(5))*sin(th(7))))-sin(th(3))*(sin(th(4)) 

Sc  *(sin(th(5))*sin(th(7))+cos(th(5))*cos(th(6))*cos(th(7)))+cos(t 
Sc  h(4))*(sin(th(5))*cos(th(6))*cos(th(7))-cos(th(5))*sin(th(7)))) 
Sc  )-cos(th(2))*sin(th(6))*cos(th(7) ) 

g(3,2)  = sin(th(2))*(cos(th(3))*(cos(th(4))*(sin(th(5) )*cos(th(7) ) 
Sc  -cos(th(5))*cos(th(6))*sin(th(7)))-sin(th(4))*(-sin(th(5))*cos( 
Sc  th(6))*sin(th(7))-cos(th(5))*cos(th(7))))-sin(th(3))*(cos(th(4) 
Sc  )*(-sin(th(5))*cos(th(6))*sin(th(7))-cos(th(5))*cos(th(7)))+sin 
Sc  (th(4) )*(sin(th(5) )*cos(th(7) )-cos(th(5))*cos(th(6))*sin(th(7) ) 
Sc  )))+cos(th(2))*sin(th(6))*sin(th(7)) 

g(3 ,3)  = sin(th(2))*(cos(th(3))*(cos(th(4))*cos(th(5))*sin(th(6))- 
Sc  sin(th(4))*sin(th(5))*sin(th(6)))-sin(th(3))*(cos(th(4))*sin(th 
Sc  (5))*sin(th(6))+sin(th(4))*cos(th(5))*sin(th(6))))+cos(th(2))*c 

Sc  os(th(6)) 

g(3,4)  = sll+sin(th(2))*(cos(th(3))*(-sin(th(4))*sin(th(5))*a56+co 
Sc  s(th(4))*cos(th(5))*a56+cos(th(4))*a45)-sin(th(3))*(cos(th(4))* 
Sc  sin(th(5) ) *a56+sin(th(4) ) *cos (th(5) ) *a56+sin(th(4) ) *a45)+cos (th 
Sc  (3))*a34)+sin(th(2))*a23 
g(4, 1)  = 0 
g(4,2)  = 0 
g(4,3)  = 0 
g(4,4)  = 1 
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Now,  from  Section  8.7,  the  motion  capability  of  the  redundant  manipulators  is 
given  by 

1 t=l 

where 


1 f 2w 

Mi  = — VidOi 

2sk  J$i=  o 

J_  |J.| 

2tt  J61 8 7=o 


d0\ . . .dOi . . . d07. 


(<7i3  + ^23) 2 

These  integrals  were  evaluated  using  a twelve  point  Gauss-Legendre  quadrature  al- 
gorithm. The  following  programmes  were  developed  to  implement  this  algorithm: 


VOLUME:  This  is  the  main  programme.  It  comprises  one  main  loop  which  is 
repeated  seven  times  to  evaluate  Mt-  for  i = 1, . . . , 7 for  a given  design  of  the 
FTSMS. 

PERMUTATION:  This  subroutine  defines  a 720  x 7 array  whose  elements  are  used 
as  a pointer  to  the  appropriate  elements  of  a 6 x 6 minor  of  the  7x6  matrix 
J.  The  pointers,  when  applied  to  the  minor  J,,  yield  the  complete  720  term 
expansion  of  its  determinant. 


QUADRATURE:  This  subroutine  applies  a twelve  point  Gauss-Legendre  quadrature 
technique  and  integrates  a function  of,  in  general,  n variables  over  specified 
limits. 


FUNCTION:  This  function  evaluates  the  expression 


1J.-I 

(#i23  + ah)2 


(B.l) 
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which  is  a function  of  the  seven  joint  angles,  and  represents  the  magnitude  of 
the  volume  of  the  parallelepiped  of  the  six  co-ordinate  induced  tangent  vectors 

tg1 , . . . , t$- , . . . , t(j7 , 

where  the  symbol  indicates  that  this  index  value  is  omitted.  This  function  is 
actually  independent  of  the  the  joint  angle  6\,  since  the  value  of  0\  is  dependent 
on  the  parameterization  of  the  base  space.  Thus,  the  expression  for  B.l  is 
symbolically  derived  by  substituting  the  value  of  zero  for  6\.  This  significantly 
reduces  its  complexity.  After  integration,  the  result  is  then  multiplied  by  the 
factor  2n  to  complete  the  integration  over  the  fist  angle. 

NUMERATOR:  This  subroutine  evaluates  |J,|  which  represents  the  determinant  of 
the  ith  6x6  minor  of  the  matrix  J.  Two  versions  of  this  subroutine  exist,  one 
for  each  design  of  the  FTSMS. 

DENOMINATOR:  This  subroutine  evaluates  g\3  + g\3.  Two  versions  of  this  subrou- 
tine exist,  one  for  each  design  of  the  FTSMS. 
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C******************************************** ******** ********* ****** 
c******************************************************************* 

c** 

c**  name:  VOLUME 

c** 

c**  purpose:  main  programme  to  evaluate  the  seven  integrals 

c**  in  the  sum  representing  the  motion  capability 

c**  for  a given  design  of  the  FTSMS 

c** 

c**  called  routines:  PERMUTATION,  QUADRATURE,  FUNCTION 

c** 

c**  variables: 

C** 

c**  x - vector  giving  lower  limit  of  integration 

c**  y - vector  giving  upper  limit  of  integration 

c**  result  - result  of  integral 

c**  errest  - error  estimate  of  integral 

c**  p - 720x7  pointer  array  from  which  the  complete  720  term 

c**  expansion  of  the  determinant  of  the  ith  6x6  minor  of 

c**  the  7x6  matrix  J 

c** 

c****** ************************************************* ********** ** 
c*************************************** ************* *************** 

integer  j , n 

double  precision  x(6) , y(6) , result,  errest 
double  precision  twopi 
double  precision  f 
external  quad,  f 

integer  p(720,7),  skip 
common  twopi,  p 

c define  dimension  of  integral 
n = 6 

twopi=2 . 0d0*3 . 1415926535897932384626434d0 

c define  limits  of  integration 
do  10  j=l ,6 
x(j)  = O.OdO 
y(j)  = twopi 
10  continue 

c main  loop  begins  and  is  repeated  for  each  of  the  seven 
c integrals  appearing  in  the  motion  capability  equation 
do  20  skip=l,7 

c define  pointer  array  which  yields  complete  720  term 
c expansion  of  the  determinant  of  the  ith  6x6  minor  of  the  7x6  matrix  J 
call  permutation(p.skip) 
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c evaluate  the  integral 

call  quadrature (f , n,  x,  y,  result,  errest) 

c complete  the  integration  about  first  joint 
result  = twopi*result 
20  write  (6,*)  result,  errest 

stop 

end 


C********************************************** ****** ******* ******** 

c** 

c**  name:  PERMUTATION 

c** 

c**  purpose:  subroutine  to  define  a 720x7  pointer  array  from  which 

c**  the  complete  720  term  expansion  of  the  determinant 

c**  of  the  ith  6x6  minor  of  the  7x6  matrix  J is  derived 

c** 

c**  calling  routine:  VOLUME 

c** 

c**  usage:  call  permutation(p , skip) 

c** 

c**  arguments: 
c** 

c**  p - 720x7  array  (output) 

c**  skip  - integer  indicating  row  of  7x6  matrix  J to  omit 

c**  to  form  6x6  minor  (input) 

c** 

c******************************************************************* 

C*  *****************************  ***************************„,*,*„<*„<**** 

subroutine  permutation(p,skip) 
integer  p(720,7),  skip 

integer  b(6),  factor 

integer  c2(6) ,c3(6) ,c4(6) ,c5(6) ,c6(6) 

integer  i,j,k,l,m,n 

c define  the  basic  vector  to  permute 
do  10  i=l,6 

if(i  .It.  skip)  then 
b(i)  = i 
c6(i)  = i 
else 

b(i)  = i + 1 
c6(i)  = i + 1 
end  if 
10  continue 

c permute  the  vector  such  that  p(i,l)  ...  p(i,6)  contains  the 
c permutation  and  p(i,7)  contains  the  sign  of  the  permuation 
i = 1 

factor  = 1 
do  60  j = 1 , 6 

call  equate (c5,b) 
do  50  k=l ,5 

call  equate(c4,b) 
do  40  1=1,4 

call  equate(c3,b) 
do  30  m=l,3 
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call  equate (c2,b) 
do  20  n=l ,2 
p(i,l)=b(l) 
p(i,2)=b(2) 
p(i,3)=b(3) 
p(i,4)=b(4) 
p(i,5)=b(5) 
p(i,6)=b(6) 
p(i,7)=factor 
i = i + 1 

20  call  perm2(c2,b, factor) 

call  perm3(c3,b, factor) 

30  call  equate (c3,b) 

call  perm4(c4,b, factor) 

40  call  equate (c4,b) 

call  perm5(c5,b, factor) 

50  call  equate(c5,b) 

call  perm6(c6,b, factor) 

60  call  equate(c6,b) 

return 
end 


subroutine  equate (m,n) 
integer  m(6),n(6),i 

do  100  i=l ,6 
100  m(i)=n(i) 

return 
end 

subroutine  perm2(a,  b,  factor) 
integer  a(6),  b(6),  factor 

b ( 1 ) = a(l) 
b(2)  = a(2) 
b(3)  = a(3) 
b(4)  = a(4) 
b(5)  = a(6) 
b(6)  = a(5) 

factor  = factor  * (-1) 

return 

end 

subroutine  perm3(a,  b,  factor) 
integer  a(6),  b(6),  factor 

b ( 1 ) = a(l) 
b(2)  = a(2) 
b(3)  = a(3) 
b(4)  = a(5) 
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b(5)  = a(6) 
b(6)  = a(4) 

factor  = factor  * (+1) 

return 

end 


subroutine  perm4(a,  b,  factor) 
integer  a(6) , b(6),  factor 

b(l)  = a(l) 
b(2)  = a(2) 
b(3)  = a(4) 
b(4)  = a(5) 
b(5)  = a(6) 
b(6)  = a(3) 

factor  = factor  * (-1) 

return 

end 


subroutine  perm5(a,  b,  factor) 
integer  a(6),  b(6),  factor 

b(l)  = a(l) 
b(2)  = a(3) 
b(3)  = a(4) 
b(4)  = a(5) 
b(5)  = a(6) 
b(6)  = a(2) 

factor  = factor  * (+1) 

return 

end 


subroutine  perm6(a,  b,  factor) 
integer  a(6) , b(6),  factor 

b(l)  = a(2) 
b(2)  = a(3) 
b(3)  = a(4) 
b(4)  = a(5) 
b(5)  = a(6) 
b(6)  = a(l) 

factor  = factor  * (-1) 

return 

end 
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C******************************************************************* 

C******************************************************************* 

C** 
c** 
c** 

C** 

c** 
c** 
c** 
c** 

C** 

c** 

C** 

c** 
c** 
c** 
c** 
c** 
c** 
c** 
c** 
c** 
c** 
c** 
c** 

C************************************* ******* ******** *************** 
C********  *****************************  *****  ************************* 

subroutine  quadrature (f , n,  a,  b,  result,  errest) 

c declaration  of  arguments 
integer  n 

double  precision  f,  a(n) , b(n),  result,  errest, 
external  f 

c declaration  of  absicissas  and  weight  vectors 
double  precision  t(255),  w(255) 

integer  i,  j,  m(20) , nn,  nn2,  nni 
double  precision  bma(20),  bpa(20) , bwt,  tint, 

& tt(256) , wt,  ww(256) , x(*) , temp 

external  iset 

c define  absicissas  and  weight  factors  for  twelve 
c point  integration  (modify  for  accuracy  desired) 
data  t(l),  t(2) , t(3),  t(4),  t(5),  t(6)/ 

& . 9815606342467 19d0 , . 904117256370475d0 , 

& . 769902674194305d0 , .587317954286617d0, 

& . 367831498998180d0,  . 12523340851 1469d0/ 

data  w ( 1 ) , w(2) , w(3),  w(4),  w(5),  w(6)/ 


name : quadrature 

purpose:  subroutine  to  integrate  a function  of  n variables 

over  an  n dimensional  hyper-rectange 

usage:  call  quadrature(f , n,  a,  b,  result,  errest) 

arguments : 

f - function  to  be  integrated  (input) 
n - dimension  of  hyper-rectangle  (input) 
a - vector  giving  lower  limits  of  integration  (input) 
b - vector  giving  upper  limits  of  integration  (input) 
result  - estimate  of  integral  over  byper-rectangle  (output) 
errest  - estimate  of  absolute  value  of  the  error  (output) 

remarks:  1]  this  routine  can  be  easily  modified  to  vary  the 

accuracy  of  the  integration  by  defining  alternate 
sets  of  abscissas  and  weight  factors  as  specified 
2]  the  value  of  n,  the  dimension  of  the 

hyper-rectangle,  must  be  less  than  or  equal  to  20 
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& . 047 175336386512d0 , . 106939325995318d0 , 
Sc  . 160078328543346d0 , .203167426723066d0, 
Sc  . 233492536538355d0 , . 249147045813403d0/ 


result  = O.OdO 
bwt  = 1 . OdO 
do  10  i=l,n 

bma(i)  = (b(i)-a(i))*0.5d0 
bpa(i)  = (b(i)+a(i))*0.5d0 
bwt  = bwt*bma(i) 

10  continue 


c use  nn  point  gaussian  formula  in  each  dimension 
c (modify  for  dimension  of  hyper-rectangle) 
nn  = 12 
nn2  = nn/2 
do  20  i=l,  nn2 
nni  = nn  + 1 - i 
tt(i)  = -t(i) 

= -tt(i) 
w(i) 

= ww(i) 


tt(nni) 
ww(i)  = 
ww(nni) 

20  continue 
call  iset 
m(l)  = 0 
tint  = O.OdO 


(n,  1,  m,  1) 


c the  following  is  equivalent  to  n nested  do-loops 
30  m(l)  = m(l)  + 1 

if  (n  .eq.  1)  go  to  50 
do  40  i=2,  n 

if  (m(i-l)  .le.  nn)  go  to  40 
m(i-l)  = 1 
m(i)  = m(i)  + 1 
40  continue 

50  if  (m(n)  .gt.  nn)  go  to  70 

wt  = bwt 
do  60  i=l,  n 
j = m(i) 
wt  = wt*ww(j) 

x(i)  = bpa(i)  + tt(j)*bma(i) 

60  continue 

temp  = f(n,x) 

tint  = tint  + temp*wt 

go  to  30 

70  result  = tint 

continue 
return 
end 


c set  the  components  of  a vector  to  a scalar,  all  integer, 
c arguments : 
c 

c n - length  of  vector  ix.  (input) 
c ia  - integer  scalar.  (input) 

c ix  - integer  vector  of  length  n*incx.  (input /output) 
c iset  replaces  ix(i)  with  ia  for  i=l,...,n.  ix(i) 

c refers  to  a specific  element  of  ix.  see  incx  argument 

c description. 

c incx  - displacement  between  elements  of  ix.  (input) 
c ix(i)  is  defined  to  be  ix(l+(i-l)*incx) . incx  must  be 

c greater  than  zero. 

subroutine  iset  (n,  ia,  ix,  incx) 
c declaration  of  arguments 

integer  n,  ia,  incx,  ix(*) 
c declaration  of  local  variables 
integer  i,  m,  mpi,  nincx 

if  (n  .gt.  0)  then 

if  (incx  .ne.  1)  then 
c code  for  increment  not  equal  to  1 
nincx  = n*incx 
do  10  i=l,  nincx,  incx 
ix(i)  = ia 
10  continue 

else 

do  20  i=l,  n 
ix(i)  = ia 
20  continue 

end  if 
end  if 
return 
end 
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c* ************************************** **************************** 
c* ****** *********************************************** ************* 
c** 

c**  name : NUMERATOR  (FTSMS  design  A) 
c** 

c**  purpose:  subroutine  to  evalutate  the  6x6  minor  of 

c**  of  the  matrix  J at  the  joint  angles  specified 

c** 

c**  calling  routine:  FUNCTION 

c** 

c**  usage:  call  numerator (minor , costh,  sinth) 

c** 

c**  arguments: 
c** 

c**  minor  - 6x6  minor  of  J evaluated  at  specified 
c**  joint  angles  (output) 

c**  costh  - vector  of  cosines  of  joint  angles  (input) 

c**  sinth  - vector  of  sines  of  joint  angles  (input) 

c** 

C* ********************************************************** ******** 

subroutine  numerator (minor , costh,  sinth) 
double  precision  minor(6,7),  costh(7) , sinth(7) 
double  precision  a23,  a34,  a45,  a67,  s22,  s55 

a23  = 9 . OdO 
a34  = 22. OdO 
a45  = 3. OdO 
a67  = 4. OdO 
s22  = 8 . 25d0 
s55  = 22. OdO 

minor (1 , 1)  = (costh (2)* (costh (3)* (costh (4) *costh(5)*sinth(6) -sinth 

1 (4)*costh(6))-sinth(3)*(sinth(4)*costh(5)*sinth(6)+costh(4)*cos 

2 th(6)))+sinth(2)*sinth(5)*sinth(6))**2-(-costh(3)*(sinth(4)*cos 

3 th(5)*sinth(6)+costh(4)*costh(6))-sinth(3)*(costh(4)*costh(5)*s 

4 inth(6)-sinth(4)*costh(6)))*(costh(3)*(sinth(4)*costh(5)*sinth( 

5 6)+costh(4)*costh(6) )+sinth(3)*(costh(4)*costh(5)*sinth(6)-sint 

6 h(4)*costh(6))) 

minor (1 ,2)  = -(-costh(3)*(sinth(4)*costh(5)*sinth(6)+costh(4)*cost 

1 h(6) )-sinth(3)*(costh(4)*costh(5)*sinth(6)-sinth(4)*costh(6)))* 

2 (costh(2)*sinth(5)*sinth(6)-sinth(2)*(costh(3)*(costh(4)*costh( 

3 5)*sinth(6)-sinth(4)*costh(6) )-sinth(3)*(sinth(4)*costh(5)*sint 

4 h(6)+costh(4)*costh(6)))) 

minor (1,3)  = (sinth(3)*(sinth(4)*costh(5)*sinth(6)+costh(4)*costh( 

1 6))-costh(3)*(costh(4)*costh(5)*sinth(6)-sinth(4)*costh(6)))*(c 

2 osth(2)*(costh(3)*(costh(4)*costh(5)*sinth(6)-sinth(4)*costh(6) 

3 )-sinth(3)*(sinth(4)*costh(5)*sinth(6)+costh(4)*costh(6) ))+sint 

4 h(2)*sinth(5)*sinth(6))-costh(2)*(-costh(3)*(sinth(4)*costh(5)* 

5 sinth(6)+costh(4) *costh(6) )-sinth(3) *(costh(4)*costh(5)*sinth(6 
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6 )-sinth(4)*costh(6)))**2 

minor (1 ,4)  = (-sinth(3)*(-sinth(4)*costh(5)*sinth(6)-costh(4)*cost 

1 h(6))-costh(3)*(costh(4)*costh(5)*sinth(6)-sinth(4)*costh(6)))* 

2 (costh(2)*(costh(3)*(costh(4)*costh(5)*sinth(6)-sinth(4)*costh( 

3 6) )-sinth(3)*(sinth(4)*costh(5)*sinth(6)+costh(4)*costh(6)))+si 

4 nth(2)*sinth(5)*sinth(6))-costh(2)*(costh(3)*(-sinth(4)*costh(5 

5 )*sinth(6)-costh(4)*costh(6))-sinth(3)*(costh(4)*costh(5)*sinth 

6 (6)-sinth(4)*costh(6)))*(-costh(3)*(sinth(4)*costh(5)*sinth(6)+ 

7 costh(4)*costh(6) )-sinth(3)*(costh(4)*costh(5) *sinth(6) -sinth(4 

8 )*costh(6))) 

minor(l ,5)  = (costh(3)*sinth(4)*sinth(5)*sinth(6)+sinth(3)*costh(4 

1 )*sinth(5)*sinth(6))*(costh(2)*(costh(3)*(costh(4)*costh(5)*sin 

2 th(6)-sinth(4)*costh(6))-sinth(3)*(sinth(4)*costh(5)*sinth(6)+c 

3 osth(4)*costh(6)))+sinth(2)*sinth(5)*sinth(6))-(-costh(3)*(sint 

4 h(4)*costh(5)*sinth(6)+costh(4)*costh(6))-sinth(3)*(costh(4)*co 

5 sth(5)*sinth(6)-sinth(4)*costh(6) ) )*(costh(2)*(sinth(3)*sinth(4 

6 )*sinth(5)*sinth(6)-costh(3)*costh(4)*sinth(5)*sinth(6))+sinth( 

7 2)*costh(5)*sinth(6)) 

minor(l ,6)  = (-sinth(3)*(sinth(4)*sinth(6)+costh(4)*costh(5)*costh 

1 (6) )-costh(3)*(sinth(4)*costh(5)*costh(6)-costh(4)*sinth(6)))*( 

2 costh(2)*(costh(3)*(costh(4)*costh(5)*sinth(6)-sinth(4)*costh(6 

3 ))-sinth(3)*(sinth(4)*costh(5)*sinth(6)+costh(4)*costh(6)) )+sin 

4 th(2)*sinth(5)*sinth(6))-(-costh(3)*(sinth(4)*costh(5)*sinth(6) 

5 +costh(4)*costh(6))-sinth(3)*(costh(4)*costh(5)*sinth(6)-sinth( 

6 4)*costh(6)))*(costh(2)*(costh(3)*(sinth(4)*sinth(6)+costh(4)*c 

7 osth(5)*costh(6))-sinth(3)*(sinth(4)*costh(5)*costh(6)-costh(4) 

8 *sinth(6)) )+sinth(2)*sinth(5)*costh(6)) 
minor (1,7)  = O.OdO 

minor (2,1)  = O.OdO 

minor (2, 2)  = -costh(2)*(costh(3)*(costh(4)*costh(5)*sinth(6)-sinth 

1 (4)*costh(6))-sinth(3)*(sinth(4)*costh(5)*sinth(6)+costh(4)*cos 

2 th(6) ))-sinth(2)*sinth(5)*sinth(6) 

minor (2, 3)  = -sinth(2)*(-costh(3)*(sinth(4)*costh(5)*sinth(6)+cost 

1 h(4)*costh(6))-sinth(3)*(costh(4)*costh(5)*sinth(6)-sinth(4)*co 

2 sth(6) ) ) 

minor (2, 4)  = -sinth(2)*(costh(3)*(-sinth(4)*costh(5)*sinth(6)-cost 

1 h(4)*costh(6))-sinth(3)*(costh(4)*costh(5)*sinth(6)-sinth(4)*co 

2 sth(6) ) ) 

minor (2, 5)  = costh(2)*costh(5)*sinth(6)-sinth(2)*(sinth(3)*sinth(4 
1 )*sinth(5)*sinth(6) -costh(3) *costh(4)*sinth(5)*sinth(6) ) 
minor (2, 6)  = costh(2)*sinth(5)*costh(6)-sinth(2)*(costh(3)*(sinth( 

1 4)*sinth(6)+costh(4)*costh(5)*costh(6))-sinth(3)*(sinth(4)*cost 

2 h(5)*costh(6)-costh(4)*sinth(6) ) ) 
minor (2, 7)  = O.OdO 

minor (3,1)  = O.OdO 

minor (3, 2)  = (costh(2)*(costh(3)*(costh(4)*(sinth(5)*sinth(7)+cost 

1 h(5)*costh(6)*costh(7))+sinth(4)*sinth(6)*costh(7))-sinth(3)*(s 

2 inth(4)*(sinth(5)*sinth(7)+costh(5)*costh(6)*costh(7))-costh(4) 

3 *sinth(6)*costh(7) ) )+sinth(2)*(sinth(5)*costh(6)*costh(7)-costh 

4 (5)*sinth(7) ) )*(sinth(2)*(costh(3)*(costh(4)*(sinth(5)*costh(7) 

5 -costh(5)*costh(6)*sinth(7))-sinth(4)*sinth(6)*sinth(7))-sinth( 
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6 3)*(sinth(4)*(sinth(5)*costh(7)-costh(5)*costh(6)*sinth(7))+cos 

7 th(4)*sinth(6)*sinth(7)))-costh(2)*(-sinth(5)*costh(6)*sinth(7) 

8 -costh(5)*costh(7)))-(sinth(2)*(costh(3)*(costh(4)*(sinth(5)*si 

9 nth(7)+costh(5)*costh(6)*costh(7) )+sinth(4) *sinth(6)*costh(7) )- 

: sinth(3)*(sinth(4)*(sinth(5)*sinth(7)+costh(5)*costh(6)*costh(7 

; ))-costh(4)*sinth(6)*costh(7)))-costh(2)*(sinth(5)*costh(6)*cos 

< th(7)-costh(5)*sinth(7)) )*(costh(2)*(costh(3)*(costh(4)*(sinth( 
= 5)*costh(7)-costh(5)*costh(6)*sinth(7))-sinth(4)*sinth(6)*sinth 

> (7))-sinth(3)*(sinth(4)*(sinth(5)*costh(7)-costh(5)*costh(6)*si 
? nth (7) )+costh(4)*sinth(6)*sinth(7) ) )+sinth(2)*(-sinth(5)*costh( 

0 6)*sinth(7)-costh(5)*costh(7))) 

minor (3, 3)  = sinth(2)*(-costh(3)*(sinth(4)*(sinth(5)*sinth(7)+cost 

1 h(5)*costh(6)*costh(7))-costh(4)*sinth(6)*costh(7) )-sinth(3)*(c 

2 osth(4)*(sinth(5)*sinth(7)+costh(5)*costh(6)*costh(7) )+sinth(4) 

3 *sinth(6)*costh(7) ) )*(sinth(2)*(costh(3)*(costh(4)*(sinth(5)*co 

4 sth(7)-costh(5)*costh(6)*sinth(7) )-sinth(4)*sinth(6)*sinth(7))- 

5 sinth(3)*(sinth(4)*(sinth(5)*costh(7)-costh(5)*costh(6)*sinth(7 

6 ))+costh(4)*sinth(6)*sinth(7)))-costh(2)*(-sinth(5)*costh(6)*si 

7 nth(7)-costh(5)*costh(7)))-sinth(2)*(-costh(3)*(sinth(4)*(sinth 

8 (5)*costh(7)-costh(5)*costh(6)*sinth(7))+costh(4)*sinth(6)*sint 

9 h(7))-sinth(3)*(costh(4)*(sinth(5)*costh(7)-costh(5)*costh(6)*s 

: inth(7))-sinth(4)*sinth(6)*sinth(7)))*(sinth(2)*(costh(3)*(cost 

; h(4)*(sinth(5)*sinth(7)+costh(5)*costh(6)*costh(7))+sinth(4)*si 

< nth(6)*costh(7) )-sinth(3) * (sinth(4) *(sinth(5)*sinth(7)+costh(5) 
= *costh(6)*costh(7))-costh(4)*sinth(6)*costh(7)))-costh(2)*(sint 

> h(5)*costh(6)*costh(7)-costh(5) *sinth(7) ) ) 

minor (3, 4)  = sinth(2)* (costh(3)*(costh(4)*sinth(6)*costh(7)-sinth( 

1 4)*(sinth(5)*sinth(7)+costh(5)*costh(6)*costh(7)))-sinth(3)*(co 

2 sth(4)*(sinth(5)*sinth(7)+costh(5)*costh(6)*costh(7))+sinth(4)* 

3 sinth(6)*costh(7)))*(sinth(2)*(costh(3)*(costh(4)*(sinth(5)*cos 

4 th(7)-costh(5)*costh(6)*sinth(7))-sinth(4)*sinth(6)*sinth(7))-s 

5 inth(3)*(sinth(4)*(sinth(5)*costh(7)-costh(5)*costh(6)*sinth(7) 

6 )+costh(4)*sinth(6)*sinth(7)))-costh(2)*(-sinth(5)*costh(6)*sin 

7 th(7)-costh(5)*costh(7)))-sinth(2)*(costh(3)*(-sinth(4)*(sinth( 

8 5)*costh(7)-costh(5)*costh(6)*sinth(7))-costh(4)*sinth(6)*sinth 

9 (7) )-sinth(3)*(costh(4)*(sinth(5)*costh(7)-costh(5)*costh(6)*si 
nth(7))-sinth(4)*sinth(6)*sinth(7)))*(sinth(2)*(costh(3)*(costh 

; (4)*(sinth(5)*sinth(7)+costh(5)*costh(6)*costh(7))+sinth(4)*sin 

< th(6)*costh(7))-sinth(3)*(sinth(4)*(sinth(5)*sinth(7)+costh(5)* 
= costh(6)*costh(7))-costh(4)*sinth(6)*costh(7)))-costh(2)*(sinth 

> (5) *costh(6)*costh(7)-costh(5)*sinth(7) ) ) 

minor (3, 5)  = (sinth(2)*(costh(3)*costh(4)*(costh(5)*sinth(7)-sinth 

1 (5)*costh(6)*costh(7) )-sinth(3)*sinth(4)*(costh(5)*sinth(7)-sin 

2 th(5)*costh(6)*costh(7)))-costh(2)*(sinth(5)*sinth(7)+costh(5)* 

3 costh(6)*costh(7)))*(sinth(2)*(costh(3)*(costh(4)*(sinth(5)*cos 

4 th(7)-costh(5)*costh(6)*sinth(7) ) -sinth(4) *sinth(6)*sinth(7) )-s 

5 inth(3)*(sinth(4)*(sinth(5)*costh(7)-costh(5)*costh(6)*sinth(7) 

6 )+costh(4)*sinth(6)*sinth(7) ) )-costh(2)*(-sinth(5)*costh(6)*sin 

7 th(7)-costh(5)*costh(7)) )-(sinth(2)*(costh(3)*costh(4)*(sinth(5 

8 )*costh(6)*sinth(7)+costh(5)*costh(7))-sinth(3)*sinth(4)*(sinth 

9 (5)*costh(6)*sinth(7)+costh(5)*costh(7) ) ) -costh(2) *(sinth(5)*co 
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: sth(7)-costh(5)*costh(6)*sinth(7)))*(sinth(2)*(costh(3)*(costh( 

; 4)*(sinth(5)*sinth(7)+costh(5)*costh(6)*costh(7) )+sinth(4)*sint 

< h(6)*costh(7) )-sinth(3)*(sinth(4)*(sinth(5)*sinth(7)+costh(5)*c 
= osth(6)*costh(7))-costh(4)*sinth(6)*costh(7) ))-costh(2)*(sinth( 

> 5)*costh(6)*costh(7)-costh(5)*sinth(7) ) ) 

minor (3, 6)  = (sinth(2)*(costh(3)*(sinth(4)*costh(6)*costh(7)-costh 

1 (4)*costh(5)*sinth(6)*costh(7))-sinth(3)*(-sinth(4)*costh(5)*si 

2 nth(6)*costh(7)-costh(4)*costh(6)*costh(7) ) )+costh(2)*sinth(5)* 

3 sinth(6)*costh(7))*(sinth(2)*(costh(3)*(costh(4)*(sinth(5)*cost 

4 h(7)-costh(5)*costh(6)*sinth(7))-sinth(4)*sinth(6)*sinth(7))-si 

5 nth(3)*(sinth(4)*(sinth(5)*costh(7)-costh(5)*costh(6)*sinth(7)) 

6 +costh(4)*sinth(6)*sinth(7)) )-costh(2)*(-sinth(5)*costh(6)*sint 

7 h(7)-costh(5)*costh(7) ))-(sinth(2)*(costh(3)*(costh(4)*costh(5) 

8 *sinth(6)*sinth(7)-sinth(4)*costh(6)*sinth(7))-sinth(3)*(sinth( 

9 4)*costh(5)*sinth(6)*sinth(7)+costh(4)*costh(6)*sinth(7)))-cost 

: h(2)*sinth(5)*sinth(6)*sinth(7))*(sinth(2)*(costh(3)*(costh(4)* 

; (sinth(5)*sinth(7)+costh(5)*costh(6)*costh(7))+sinth(4)*sinth(6 

< )*costh(7))-sinth(3)*(sinth(4)*(sinth(5)*sinth(7)+costh(5)*cost 

= h(6)*costh(7))-costh(4)*sinth(6)*costh(7)))-costh(2)*(sinth(5)* 

> costh(6)*costh(7)-costh(5)*sinth(7)) ) 

minor (3 ,7)  = (sinth(2)*(costh(3)*(costh(4)*(sinth(5)*costh(7)-cost 

1 h(5)*costh(6)*sinth(7))-sinth(4)*sinth(6)*sinth(7))-sinth(3)*(s 

2 inth(4)*(sinth(5)*costh(7)-costh(5)*costh(6)*sinth(7))+costh(4) 

3 *sinth(6)*sinth(7)))-costh(2)*(-sinth(5)*costh(6)*sinth(7)-cost 

4 h(5)*costh(7)))**2-(sinth(2)*(costh(3)*(costh(4)*(-sinth(5)*sin 

5 th(7)-costh(5)*costh(6)*costh(7))-sinth(4)*sinth(6)*costh(7))-s 

6 inth(3)*(sinth(4)*(-sinth(5)*sinth(7)-costh(5)*costh(6)*costh(7 

7 ))+costh(4)*sinth(6)*costh(7)))-costh(2)*(costh(5)*sinth(7)-sin 

8 th(5)*costh(6)*costh(7)))*(sinth(2)*(costh(3)*(costh(4)*(sinth( 

9 5)*sinth(7)+costh(5)*costh(6)*costh(7))+sinth(4)*sinth(6)*costh 

: (7))-sinth(3)*(sinth(4)*(sinth(5)*sinth(7)+costh(5)*costh(6)*co 

; sth(7))-costh(4)*sinth(6)*costh(7)))-costh(2)*(sinth(5)*costh(6 

< )*costh(7)-costh(5)*sinth(7))) 

minor (4,1)  = sinth(3)*(sinth(4)*(s55+sinth(6)*a67)+costh(4)*costh( 

1 5)*costh(6)*a67+costh(4)*a45)+costh(3)*(-costh(4)*(s55+sinth(6) 

2 *a67)+sinth(4)*costh(5)*costh(6)*a67+sinth(4)*a45)+s22+sinth(3) 

3 *a34 

minor (4, 2)  = -sinth(2)*(costh(3)*(sinth(4)*(s55+sinth(6)*a67)+cost 

1 h(4)*costh(5)*costh(6)*a67+costh(4)*a45)-sinth(3)*(-costh(4)*(s 

2 55+sinth(6)*a67)+sinth(4)*costh(5)*costh(6)*a67+sinth(4)*a45)+c 

3 osth(3)*a34)+costh(2)*sinth(5)*costh(6)*a67-sinth(2)*a23 
minor (4, 3)  = costh(2)*(-sinth(3)*(sinth(4)*(s55+sinth(6)*a67)+cost 

1 h(4)*costh(5)*costh(6)*a67+costh(4)*a45)-costh(3)*(-costh(4)*(s 

2 55+sinth(6)*a67)+sinth(4)*costh(5)*costh(6)*a67+sinth(4)*a45)-s 

3 inth(3)*a34) 

minor (4 ,4)  = costh(2)*(costh(3)*(costh(4)*(s55+sinth(6)*a67)-sinth 

1 (4)*costh(5)*costh(6)*a67-sinth(4)*a45)-sinth(3)*(sinth(4)*(s55 

2 +sinth(6)*a67)+costh(4)*costh(5)*costh(6)*a67+costh(4)*a45)) 
minor(4,5)  = costh(2)*(sinth(3)*sinth(4)*sinth(5)*costh(6)*a67-cos 

1 th(3)*costh(4)*sinth(5)*costh(6)*a67)+sinth(2)*costh(5)*costh(6 

2 )*a67 
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minor (4 ,6)  = costh(2)*(costh(3)*(sinth(4)*costh(6)*a67-costh(4)*co 

1 sth(5)*sinth(6)*a67)-sinth(3)*(-sinth(4)*costh(5)*sinth(6)*a67- 

2 costh(4)*costh(6)*a67) )-sinth(2)*sinth(5)*sinth(6)*a67 
minor (4, 7)  = O.OdO 

minor (5, 1)  = costh(2)*(costh(3)*(sinth(4)*(s55+sinth(6)*a67)+costh 

1 (4) *costh(5) *costh(6)*a67+costh(4) *a45)-sinth(3)*(-costh(4)* (s5 

2 5+sinth(6)*a67)+sinth(4)*costh(5)*costh(6)*a67+sinth(4)*a45)+co 

3 sth(3)*a34)+sinth(2)*sinth(5)*costh(6)*a67+costh(2)*a23 
minor (5, 2)  = O.OdO 

minor (5, 3)  = -costh(3)*(sinth(4)*(s55+sinth(6)*a67)+costh(4)*costh 

1 (5)*costh(6)*a67+costh(4)*a45)+sinth(3)*(-costh(4)*(s55+sinth(6 

2 )*a67)+sinth(4)*costh(5)*costh(6)*a67+sinth(4)*a45)-costh(3)*a3 

3 4 

minor (5, 4)  = -costh(3)*(sinth(4)*(s55+sinth(6)*a67)+costh(4)*costh 

1 (5)*costh(6)*a67+costh(4)*a45)-sinth(3)*(costh(4)*(s55+sinth(6) 

2 *a67)-sinth(4)*costh(5)*costh(6)*a67-sinth(4)*a45) 

minor (5, 5)  = costh(3)*sinth(4)*sinth(5)*costh(6)*a67+sinth(3)*cost 
1 h(4)*sinth(5)*costh(6)*a67 

minor (5, 6)  = -costh(3)*(-sinth(4)*costh(5)*sinth(6)*a67-costh(4)*c 

1 osth(6)*a67)-sinth(3)*(sinth(4)*costh(6)*a67-costh(4)*costh(5)* 

2 sinth(6)*a67) 
minor(5,7)  = O.OdO 
minor (6,1)  = O.OdO 

minor (6, 2)  = costh(2)*(costh(3)*(sinth(4)*(s55+sinth(6)*a67)+costh 

1 (4)*costh(5)*costh(6)*a67+costh(4)*a45)-sinth(3)*(-costh(4)*(s5 

2 5+sinth(6)*a67)+sinth(4)*costh(5)*costh(6)*a67+sinth(4)*a45)+co 

3 sth(3)*a34)+sinth(2)*sinth(5)*costh(6)*a67+costh(2)*a23 

minor (6, 3)  = sinth(2)*(-sinth(3)*(sinth(4)*(s55+sinth(6)*a67)+cost 

1 h(4)*costh(5)*costh(6)*a67+costh(4)*a45)-costh(3)*(-costh(4)*(s 

2 55+sinth(6)*a67)+sinth(4) *costh(5)*costh(6)*a67+sinth(4) *a45) -s 

3 inth(3)*a34) 

minor (6, 4)  = sinth(2)*(costh(3)*(costh(4)*(s55+sinth(6)*a67)-sinth 

1 (4)*costh(5)*costh(6)*a67-sinth(4)*a45)-sinth(3)*(sinth(4)*(s55 

2 +sinth(6)*a67)+costh(4)*costh(5)*costh(6)*a67+costh(4)*a45)) 
minor (6, 5)  = sinth(2)*(sinth(3)*sinth(4)*sinth(5)*costh(6)*a67-cos 

1 th(3)*costh(4)*sinth(5)*costh(6)*a67)-costh(2)*costh(5)*costh(6 

2 )*a67 

minor (6, 6)  = sinth(2)*(costh(3)*(sinth(4)*costh(6)*a67-costh(4)*co 

1 sth(5)*sinth(6)*a67)-sinth(3)*(-sinth(4)*costh(5)*sinth(6)*a67- 

2 costh(4)*costh(6)*a67))+costh(2)*sinth(5)*sinth(6)*a67 
minor(6,7)  = O.OdO 

return 

end 
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c********************** ******** ************** ********** ******* ****** 
c******************************************************************* 

c** 

c**  name:  NUMERATOR  (ftsms  design  B) 
c** 

c**  purpose:  subroutine  to  evalutate  6x6  minor  of 

c**  of  the  matrix  J at  the  joint  angles  specified 

c** 

c**  calling  routine:  FUNCTION 

c** 

c**  usage:  call  numerator (minor , costh,  sinth) 

c** 

c**  arguments : 
c** 

c**  minor  - 6x6  minor  of  j evaluated  at  specified 
c**  joint  angles  (output) 

c**  costh  - vector  of  cosines  of  joint  angles  (input) 

c**  sinth  - vector  of  sines  of  joint  angles  (input) 

c** 

c******************************************************************* 

c******************************************************************* 

subroutine  numerator (minor , costh,  sinth) 
double  precision  minor(6,7),  costh(7) , sinth(7) 
double  precision  a23,  a34,  a45,  a56,  s22 

a23  = 9.0d0 
a34  = 22 . OdO 
a45  = 22. OdO 
a56  = 4. OdO 
s22  = 8 . 25d0 

minor (1 , 1)  = (costh(2)*(costh(3)*(costh(4)*costh(5)*sinth(6)-sinth 

1 (4)*sinth(5)*sinth(6))-sinth(3)*(costh(4)*sinth(5)*sinth(6)+sin 

2 th(4)*costh(5)*sinth(6)))-sinth(2)*costh(6))**2-(-sinth(3)*(cos 

3 th(4)*costh(5)*sinth(6)-sinth(4)*sinth(5)*sinth(6))-costh(3)*(c 

4 osth(4)*sinth(5)*sinth(6)+sinth(4)*costh(5)*sinth(6)))*(sinth(3 

5 )*(costh(4)*costh(5)*sinth(6)-sinth(4)*sinth(5)*sinth(6) )+costh 

6 (3)*(costh(4)*sinth(5)*sinth(6)+sinth(4)*costh(5)*sinth(6))) 
minor(l ,2)  = -(-sinth(3)*(costh(4)*costh(5)*sinth(6)-sinth(4)*sint 

1 h(5)*sinth(6) )-costh(3)*(costh(4)*sinth(5)*sinth(6)+sinth(4)*co 

2 sth(5)*sinth(6) ))*(-sinth(2)*(costh(3)*(costh(4)*costh(5)*sinth 

3 (6)-sinth(4)*sinth(5)*sinth(6))-sinth(3)*(costh(4)*sinth(5)*sin 

4 th(6)+sinth(4)*costh(5)*sinth(6) ) )-costh(2)*costh(6)) 
minor(l ,3)  = (sinth(3)*(costh(4)*sinth(5)*sinth(6)+sinth(4)*costh( 

1 5)*sinth(6) )-costh(3)*(costh(4)*costh(5)*sinth(6)-sinth(4)*sint 

2 h(5)*sinth(6)))*(costh(2)*(costh(3)*(costh(4)*costh(5)*sinth(6) 

3 -sinth(4)*sinth(5)*sinth(6) ) -sinth (3)* (costh (4) *sinth(5) *sinth( 

4 6)+sinth(4)*costh(5)*sinth(6)))-sinth(2)*costh(6))-costh(2)*(-s 

5 inth(3)*(costh(4)*costh(5)*sinth(6)-sinth(4)*sinth(5)*sinth(6) ) 

6 -costh(3)*(costh(4)*sinth(5)*sinth(6)+sinth(4)*costh(5)*sinth(6 
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7 )))**2 

minor (1 ,4)  = (-costh(3)*(costh(4)*costh(5)*sinth(6)-sinth(4)*sinth 

1 (5)*sinth(6) )-sinth(3)*(-costh(4)*sinth(5)*sinth(6)-sinth(4)*co 

2 sth(5)*sinth(6)))*(costh(2)*(costh(3)*(costh(4)*costh(5)*sinth( 

3 6)-sinth(4)*sinth(5)*sinth(6))-sinth(3)*(costh(4)*sinth(5)*sint 

4 h(6)+sinth(4)*costh(5)*sinth(6) ))-sinth(2)*costh(6) )-costh(2)*( 

5 costh(3)*(-costh(4)*sinth(5)*sinth(6)-sinth(4)*costh(5)*sinth(6 

6 ))-sinth(3)*(costh(4)*costh(5)*sinth(6)-sinth(4)*sinth(5)*sinth 

7 (6)) )*(-sinth(3)*(costh(4)*costh(5)*sinth(6)-sinth(4)*sinth(5)* 

8 sinth(6))-costh(3)*(costh(4)*sinth(5)*sinth(6)+sinth(4)*costh(5 

9 )*sinth(6))) 

minor (1 ,5)  = (-costh(3)*(costh(4)*costh(5)*sinth(6)-sinth(4)*sinth 

1 (5)*sinth(6) )-sinth(3)*(-costh(4)*sinth(5)*sinth(6)-sinth(4)*co 

2 sth(5)*sinth(6) ) )*(costh(2)*(costh(3)*(costh(4)*costh(5)*sinth( 

3 6)-sinth(4)*sinth(5)*sinth(6) )-sinth(3)*(costh(4)*sinth(5)*sint 

4 h(6)+sinth(4)*costh(5)*sinth(6) ) )-sinth(2)*costh(6))-costh(2)*( 

5 costh(3)*(-costh(4)*sinth(5)*sinth(6)-sinth(4)*costh(5)*sinth(6 

6 ) )-sinth(3)*(costh(4)*costh(5)*sinth(6)-sinth(4)*sinth(5)*sinth 

7 (6) ) )*(-sinth(3)*(costh(4)*costh(5)*sinth(6)-sinth(4)*sinth(5)* 

8 sinth(6))-costh(3)*(costh(4)*sinth(5)*sinth(6)+sinth(4)*costh(5 

9 )*sinth(6))) 

minor (1 ,6)  = (-sinth(3)*(costh(4)*costh(5)*costh(6)-sinth(4)*sinth 

1 (5)*costh(6))-costh(3)*(costh(4)*sinth(5)*costh(6)+sinth(4)*cos 

2 th(5)*costh(6)))*(costh(2)*(costh(3)*(costh(4)*costh(5)*sinth(6 

3 )-sinth(4)*sinth(5)*sinth(6) )-sinth(3)*(costh(4)*sinth(5)*sinth 

4 (6)+sinth(4)*costh(5)*sinth(6)))-sinth(2)*costh(6) )-(sinth(2)*s 

5 inth(6)+costh(2)*(costh(3)*(costh(4)*costh(5)*costh(6)-sinth(4) 

6 *sinth(5)*costh(6))-sinth(3)*(costh(4)*sinth(5)*costh(6)+sinth( 

7 4)*costh(5)*costh(6))))*(-sinth(3)*(costh(4)*costh(5)*sinth(6)~ 

8 sinth(4)*sinth(5)*sinth(6) )-costh(3)*(costh(4)*sinth(5)*sinth(6 

9 )+sinth(4)*costh(5)*sinth(6) ) ) 
minor(l,7)  = O.OdO 

minor (2,1)  = O.OdO 

minor (2, 2)  = sinth(2)*costh(6)-costh(2)*(costh(3)*(costh(4)*costh( 

1 5)*sinth(6)-sinth(4)*sinth(5)*sinth(6))-sinth(3)*(costh(4)*sint 

2 h(5)*sinth(6)+sinth(4)*costh(5)*sinth(6))) 

minor (2, 3)  = -sinth(2)*(-sinth(3)*(costh(4)*costh(5)*sinth(6)-sint 

1 h(4)*sinth(5)*sinth(6) )-costh(3)*(costh(4)*sinth(5)*sinth(6)+si 

2 nth(4)*costh(5)*sinth(6))) 

minor (2, 4)  = -sinth(2)*(costh(3)*(-costh(4)*sinth(5)*sinth(6)-sint 

1 h(4)*costh(5)*sinth(6))-sinth(3)*(costh(4)*costh(5)*sinth(6)-si 

2 nth(4)*sinth(5)*sinth(6))) 

minor (2, 5)  = -sinth(2)*(costh(3)*(-costh(4)*sinth(5)*sinth(6)-sint 

1 h(4)*costh(5)*sinth(6) )-sinth(3)*(costh(4)*costh(5)*sinth(6)-si 

2 nth(4)*sinth(5)*sinth(6) ) ) 

minor (2, 6)  = costh(2)*sinth(6)-sinth(2)*(costh(3)*(costh(4)*costh( 

1 5)*costh(6)-sinth(4)*sinth(5)*costh(6))-sinth(3)*(costh(4)*sint 

2 h(5)*costh(6)+sinth(4)*costh(5)*costh(6))) 
minor(2,7)  = O.OdO 

minor (3,1)  = O.OdO 

minor (3, 2)  = (costh(2)*(costh(3)*(costh(4)*(sinth(5)*sinth(7)+cost 
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1 h(5)*costh(6)*costh(7) )-sinth(4)*(sinth(5)*costh(6)*costh(7)-co 

2 sth(5)*sinth(7)))-sinth(3)*(sinth(4)*(sinth(5)*sinth(7)+costh(5 

3 )*costh(6)*costh(7) )+costh(4)*(sinth(5)*costh(6)*costh(7)-costh 

4 (5)*sinth(7) )))+sinth(2)*sinth(6)*costh(7) )*(sinth(2)*(costh(3) 

5 *(costh(4)*(sinth(5)*costh(7)-costh(5)*costh(6)*sinth(7))-sinth 

6 (4)*(-sinth(5)*costh(6)*sinth(7)-costh(5)*costh(7) ) )-sinth(3)*( 

7 costh(4) *(-sinth(5)*costh(6)*sinth(7)-costh(5)*costh(7) )+sinth( 

8 4)*(sinth(5)*costh(7)-costh(5)*costh(6)*sinth(7)) ))+costh(2)*si 

9 nth(6)*sinth(7))-(sinth(2)*(costh(3)*(costh(4)*(sinth(5)*sinth( 

: 7)+costh(5)*costh(6)*costh(7) )-sinth(4)*(sinth(5)*costh(6)*cost 

; h(7)-costh(5)*sinth(7)))-sinth(3)*(sinth(4)*(sinth(5)*sinth(7)+ 

< costh(5)*costh(6)*costh(7) )+costh(4)*(sinth(5)*costh(6)*costh(7 
= )-costh(5)*sinth(7) ) ) )-costh(2)*sinth(6)*costh(7))*(costh(2)*(c 

> osth(3)*(costh(4)*(sinth(5)*costh(7)-costh(5)*costh(6)*sinth(7) 
? )-sinth(4)*(-sinth(5)*costh(6)*sinth(7)-costh(5)*costh(7)))-sin 

0 th(3)*(costh(4)*(-sinth(5)*costh(6)*sinth(7)-costh(5)*costh(7)) 

1 +sinth(4)*(sinth(5)*costh(7)-costh(5)*costh(6)*sinth(7)) ) )-sint 

2 h(2)*sinth(6)*sinth(7)) 

minor (3, 3)  = sinth(2)*(-costh(3)*(sinth(4)*(sinth(5)*sinth(7)+cost 

1 h(5)*costh(6)*costh(7))+costh(4)*(sinth(5)*costh(6)*costh(7)-co 

2 sth(5)*sinth(7)))-sinth(3)*(costh(4)*(sinth(5)*sinth(7)+costh(5 

3 )*costh(6)*costh(7))-sinth(4)*(sinth(5)*costh(6)*costh(7)-costh 

4 (5)*sinth(7))) )*(sinth(2)*(costh(3)*(costh(4)*(sinth(5)*costh(7 

5 )-costh(5)*costh(6)*sinth(7))-sinth(4)*(-sinth(5)*costh(6)*sint 

6 h(7)-costh(5)*costh(7)))-sinth(3)*(costh(4)*(-sinth(5)*costh(6) 

7 *sinth(7)-costh(5)*costh(7))+sinth(4)*(sinth(5)*costh(7)-costh( 

8 5)*costh(6)*sinth(7)) ) )+costh(2)*sinth(6)*sinth(7))-sinth(2)*(- 

9 sinth(3)*(costh(4)*(sinth(5)*costh(7)-costh(5)*costh(6)*sinth(7 

: ))-sinth(4)*(-sinth(5)*costh(6)*sinth(7)-costh(5)*costh(7)))-co 

; sth(3)*(costh(4)*(-sinth(5) *costh(6)*sinth(7)-costh(5)*costh(7) 

< )+sinth(4)*(sinth(5)*costh(7)-costh(5)*costh(6)*sinth(7))))*(si 
= nth(2)*(costh(3)*(costh(4)*(sinth(5)*sinth(7)+costh(5)*costh(6) 

> *costh(7))-sinth(4)*(sinth(5)*costh(6)*costh(7)-costh(5)*sinth( 

? 7) ))-sinth(3)*(sinth(4)*(sinth(5)*sinth(7)+costh(5)*costh(6)*co 

0 sth(7))+costh(4)*(sinth(5)*costh(6)*costh(7)-costh(5)*sinth(7)) 

1 ))-costh(2)*sinth(6)*costh(7)) 

minor (3, 4)  = sinth(2)*(costh(3)*(-sinth(4)*(sinth(5)*sinth(7)+cost 

1 h(5)*costh(6)*costh(7) )-costh(4)*(sinth(5)*costh(6)*costh(7)-co 

2 sth(5)*sinth(7) ) ) -sinth(3)*(costh(4) *(sinth(5) *sinth(7)+costh(5 

3 )*costh(6)*costh(7))-sinth(4)*(sinth(5)*costh(6)*costh(7)-costh 

4 (5)*sinth(7))))*(sinth(2)*(costh(3)*(costh(4)*(sinth(5)*costh(7 

5 )-costh(5)*costh(6)*sinth(7))-sinth(4)*(-sinth(5)*costh(6)*sint 

6 h(7)-costh(5)*costh(7)))-sinth(3)*(costh(4)*(-sinth(5)*costh(6) 

7 *sinth(7)-costh(5)*costh(7))+sinth(4)*(sinth(5)*costh(7)-costh( 

8 5)*costh(6)*sinth(7) )))+costh(2)*sinth(6)*sinth(7) )-sinth(2)*(c 

9 osth(3)*(-costh(4)*(-sinth(5)*costh(6)*sinth(7)-costh(5)*costh( 

: 7))-sinth(4)*(sinth(5)*costh(7)-costh(5)*costh(6)*sinth(7)))-si 

; nth(3)*(costh(4)*(sinth(5)*costh(7)-costh(5)*costh(6)*sinth(7)) 

< -sinth(4)*(-sinth(5)*costh(6)*sinth(7)-costh(5)*costh(7))))*(si 
= nth(2)*(costh(3)*(costh(4)*(sinth(5)*sinth(7)+costh(5)*costh(6) 

> *costh(7))-sinth(4)*(sinth(5)*costh(6)*costh(7)-costh(5)*sinth( 
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? 7)) )-sinth(3)*(sinth(4)*(sinth(5)*sinth(7)+costh(5)*costh(6)*co 

0 sth(7))+costh(4)*(sinth(5)*costh(6)*costh(7)-costh(5)*sinth(7) ) 

1 ))-costh(2)*sinth(6)*costh(7)) 

minor (3, 5)  = sinth(2)*(costh(3)*(costh(4)*(costh(5)*sinth(7)-sinth 

1 (5)*costh(6)*costh(7))-sinth(4)*(sinth(5)*sinth(7)+costh(5)*cos 

2 th(6)*costh(7) ) )-sinth(3)*(costh(4)*(sinth(5)*sinth(7)+costh(5) 

3 *costh(6)*costh(7) )+sinth(4)*(costh(5)*sinth(7)-sinth(5)*costh( 

4 6)*costh(7)) ) )*(sinth(2)*(costh(3)*(costh(4)*(sinth(5)*costh(7) 

5 -costh(5)*costh(6)*sinth(7) )-sinth(4)*(-sinth(5)*costh(6)*sinth 

6 (7)-costh(5)*costh(7) ) )-sinth(3)*(costh(4)*(-sinth(5)*costh(6)* 

7 sinth(7)-costh(5)*costh(7) )+sinth(4)*(sinth(5)*costh(7)-costh(5 

8 )*costh(6)*sinth(7))))+costh(2)*sinth(6)*sinth(7))-sinth(2)*(co 

9 sth(3)*(costh(4)* (sinth(5) *costh(6)*sinth(7)+costh(5) *costh(7) ) 

: -sinth(4)*(sinth(5) *costh(7)-costh(5)*costh(6) *sinth(7) ) )-sinth 

; (3)*(sinth(4)*(sinth(5)*costh(6)*sinth(7)+costh(5)*costh(7))+co 

< sth(4)*(sinth(5)*costh(7)-costh(5)*costh(6)*sinth(7))) )*(sinth( 
= 2)*(costh(3)*(costh(4)*(sinth(5)*sinth(7)+costh(5)*costh(6)*cos 

> th(7))-sinth(4)*(sinth(5)*costh(6)*costh(7)-costh(5)*sinth(7))) 

? -sinth(3) * (sinth(4)*(sinth(5) *sinth(7)+costh(5)*costh(6)*costh( 
@ 7))+costh(4)*(sinth(5)*costh(6)*costh(7)-costh(5)*sinth(7))))-c 

1  osth(2)*sinth(6)*costh(7) ) 

minor (3 ,6)  = (sinth(2)*(costh(3)*(sinth(4)*sinth(5)*sinth(6)*costh 

1 (7)-costh(4)*costh(5)*sinth(6)*costh(7))-sinth(3)*(-costh(4)*si 

2 nth(5)*sinth(6)*costh(7)-sinth(4)*costh(5)*sinth(6)*costh(7)))~ 

3 costh(2)*costh(6)*costh(7))*(sinth(2)*(costh(3)*(costh(4)*(sint 

4 h(5)*costh(7)-costh(5)*costh(6)*sinth(7))-sinth(4)*(-sinth(5)*c 

5 osth(6)*sinth(7)-costh(5)*costh(7)) )-sinth(3)*(costh(4)*(-sinth 

6 (5)*costh(6)*sinth(7)-costh(5)*costh(7))+sinth(4)*(sinth(5)*cos 

7 th(7)-costh(5)*costh(6)*sinth(7))))+costh(2)*sinth(6)*sinth(7)) 

8 -(sinth(2)*(costh(3)*(costh(4)*costh(5)*sinth(6)*sinth(7)-sinth 

9 (4)*sinth(5)*sinth(6)*sinth(7))-sinth(3)*(costh(4)*sinth(5)*sin 

: th(6)*sinth(7)+sinth(4)*costh(5)*sinth(6)*sinth(7)))+costh(2)*c 

; osth(6)*sinth(7) )*(sinth(2)*(costh(3)*(costh(4)*(sinth(5)*sinth 

< (7)+costh(5)*costh(6)*costh(7))-sinth(4)*(sinth(5)*costh(6)*cos 
= th(7)-costh(5)*sinth(7)))-sinth(3)*(sinth(4)*(sinth(5)*sinth(7) 

> +costh(5)*costh(6)*costh(7))+costh(4)*(sinth(5)*costh(6)*costh( 

? 7)-costh(5)*sinth(7))))-costh(2)*sinth(6)*costh(7)) 

minor (3, 7)  = (sinth(2)*(costh(3)*(costh(4)*(sinth(5)*costh(7)-cost 

1 h(5)*costh(6)*sinth(7))-sinth(4)*(-sinth(5)*costh(6)*sinth(7)-c 

2 osth(5)*costh(7)))-sinth(3)*(costh(4)*(-sinth(5)*costh(6)*sinth 

3 (7)-costh(5)*costh(7) )+sinth(4) *(sinth(5) *costh(7)-costh(5)*cos 

4 th(6) *sinth(7) ) ) )+costh(2)*sinth(6)*sinth(7) )**2- (sinth(2) *(cos 

5 th(3)*(costh(4)*(-sinth(5)*sinth(7)-costh(5)*costh(6)*costh(7)) 

6 -sinth(4) *(costh(5)*sinth(7)-sinth(5)*costh(6) *costh(7) ) )-sinth 

7 (3)*(sinth(4)*(-sinth(5)*sinth(7)-costh(5)*costh(6)*costh(7))+c 

8 osth(4)*(costh(5)*sinth(7)-sinth(5)*costh(6)*costh(7))))+costh( 

9 2)*sinth(6)*costh(7))*(sinth(2)*(costh(3)*(costh(4)*(sinth(5)*s 

: inth(7)+costh(5)*costh(6)*costh(7))-sinth(4)*(sinth(5)*costh(6) 

; *costh(7)-costh(5)*sinth(7)))-sinth(3)*(sinth(4)*(sinth(5)*sint 

< h(7)+costh(5)*costh(6)*costh(7))+costh(4)*(sinth(5)*costh(6)*co 
= sth(7)-costh(5)*sinth(7) ) ) )-costh(2)*sinth(6)*costh(7) ) 
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minor (4, 1)  = s22+sinth(3)*(-sinth(4)*sinth(5)*a56+costh(4)*costh(5 

1 )*a56+costh(4)*a45)+costh(3)*(costh(4)*sinth(5)*a56+sinth(4)*co 

2 sth(5)*a56+sinth(4)*a45)+sinth(3)*a34 

minor (4 ,2)  = -sinth(2)*(costh(3)*(-sinth(4)*sinth(5)*a56+costh(4)* 

1 costh(5)*a56+costh(4)*a45)-sinth(3)*(costh(4)*sinth(5)*a56+sint 

2 h(4)*costh(5)*a56+sinth(4)*a45)+costh(3)*a34)-sinth(2)*a23 
minor (4, 3)  = costh(2)*(-sinth(3)*(-sinth(4)*sinth(5)*a56+costh(4)* 

1 costh(5)*a56+costh(4)*a45)-costh(3)*(costh(4)*sinth(5)*a56+sint 

2 h(4) *costh(5) *a56+sinth(4) *a45) -sinth(3) *a34) 

minor (4, 4)  = costh(2)*(costh(3)*(-costh(4)*sinth(5)*a56-sinth(4)*c 

1 osth(5)*a56-sinth(4)*a45)-sinth(3)*(-sinth(4)*sinth(5)*a56+cost 

2 h(4)*costh(5)*a56+costh(4)*a45) ) 

minor (4,5)  = costh(2)*(costh(3) * (-costh(4) *sinth(5) *a56-sinth(4) *c 

1 osth(5)*a56)-sinth(3)*(costh(4)*costh(5)*a56-sinth(4)*sinth(5)* 

2 a56) ) 

minor (4, 6)  = O.OdO 
minor (4, 7)  = O.OdO 

minor (5, 1)  = costh(2)*(costh(3)*(-sinth(4)*sinth(5)*a56+costh(4)*c 

1 osth(5)*a56+costh(4)*a45)-sinth(3)*(costh(4)*sinth(5)*a56+sinth 

2 (4) *costh(5) *a56+sinth(4)*a45)+costh(3)*a34)+costh(2)*a23 
minor (5, 2)  = O.OdO 

minor (5, 3)  = -costh(3)*(-sinth(4)*sinth(5)*a56+costh(4)*costh(5)*a 

1 56+costh(4)*a45)+sinth(3)*(costh(4)*sinth(5)*a56+sinth(4)*costh 

2 (5)*a56+sinth(4)*a45)-costh(3)*a34 

minor (5, 4)  = -costh(3)*(-sinth(4)*sinth(5)*a56+costh(4)*costh(5)*a 

1 56+costh(4)*a45)-sinth(3)*(-costh(4)*sinth(5)*a56-sinth(4)*cost 

2 h(5)*a56-sinth(4)*a45) 

minor (5, 5)  = -costh(3)*(costh(4)*costh(5)*a56-sinth(4)*sinth(5)*a5 
1 6)-sinth(3)*(-costh(4)*sinth(5)*a56-sinth(4)*costh(5)*a56) 

minor(5,6)  = O.OdO 
minor(5,7)  = O.OdO 
minor(6,l)  = O.OdO 

minor (6, 2)  = costh(2)*(costh(3)*(-sinth(4)*sinth(5)*a56+costh(4)*c 

1 osth(5)*a56+costh(4)*a45)-sinth(3)*(costh(4)*sinth(5)*a56+sinth 

2 (4)*costh(5)*a56+sinth(4)*a45)+costh(3)*a34)+costh(2)*a23 
minor (6, 3)  = sinth(2)*(-sinth(3)*(-sinth(4)*sinth(5)*a56+costh(4)* 

1 costh(5)*a56+costh(4)*a45)-costh(3)*(costh(4)*sinth(5)*a56+sint 

2 h(4)*costh(5)*a56+sinth(4)*a45)-sinth(3) *a34) 

minor (6 ,4)  = sinth(2)*(costh(3)*(-costh(4)*sinth(5)*a56-sinth(4)*c 

1 osth(5)*a56-sinth(4)*a45)-sinth(3)*(-sinth(4)*sinth(5)*a56+cost 

2 h(4)*costh(5)*a56+costh(4)*a45) ) 

minor (6, 5)  = sinth(2)*(costh(3)*(-costh(4)*sinth(5)*a56-sinth(4)*c 

1 osth(5)*a56)-sinth(3)*(costh(4)*costh(5)*a56-sinth(4)*sinth(5)* 

2 a56) ) 

minor (6, 6)  = O.OdO 
minor (6, 7)  = O.OdO 
return 
end 
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C*  Jit******************!)!*************************  ********************* 
Q******************************************************************* 

c** 

C** 

c** 

C** 

C** 

c** 

C** 

c** 
c** 
c** 
c** 
c** 
c** 
c** 

C** 

c** 

C** 

C******************************************************************* 

C******************************************************************* 

subroutine  denominator (denom2,  costh,  sinth) 
double  precision  denom2,  costh(7) , sinth(7) 

c declare  constant  manipulator  parameters 

double  precision  a23,  a34,  a45,  a67,  s22,  s55 

c define  constant  manipulator  parameters 
a23  = 9 .OdO 
a34  = 22. OdO 
a45  = 3. OdO 
a67  = 4. OdO 
s22  = 8 . 25d0 
s55  = 22. OdO 

denom2  = (costh(2)*(costh(3)*(costh(4)*costh(5)*sinth(6)-sinth(4)* 

1 costh(6))-sinth(3)*(sinth(4)*costh(5)*sinth(6)+costh(4)*costh(6 

2 ) ))+sinth(2)*sinth(5)*sinth(6))**2+(-costh(3)*(sinth(4)*costh(5 

3 )*sinth(6)+costh(4)*costh(6))-sinth(3)*(costh(4)*costh(5)*sinth 

4 (6)-sinth(4)*costh(6)))**2 

return 

end 


name:  DENOMINATOR  (FTSMS  design  A) 

purpose:  subroutine  to  evaluate  the  denominator  of 

the  integrand  at  the  joint  angles  specified 

calling  routine:  FUNCTION 

usage:  call  denominator(denom2,  costh,  sinth) 

arguments : 

denom2  - denominator  evaluated  at  specified 
joint  angles  (output) 

costh  - vector  of  cosines  of  joint  angles  (input) 
sinth  - vector  of  sines  of  joint  angles  (input) 


c* *********** *********************** *********************** ********* 
c******************************************************************* 
c** 

c**  name:  DENOMINATOR  (FTSMS  design  B) 
c** 

c**  purpose:  subroutine  to  evaluate  the  denominator  of 

c**  the  integrand  at  the  joint  angles  specified 

c** 

c**  calling  routine:  FUNCTION 

c** 

c**  usage:  call  denominator(denom2,  costh,  sinth) 

c** 

c**  arguments: 
c** 

c**  denom2  - denominator  evaluated  at  specified 
c**  joint  angles  (output) 

c**  costh  - vector  of  cosines  of  joint  angles  (input) 

c**  sinth  - vector  of  sines  of  joint  angles  (input) 

c** 

c******************************************************************* 

c* ********************************************************** ******** 

subroutine  denominator (denom2 , costh,  sinth) 
double  precision  denom2,  costh(7),  sinth(7) 

c declare  constant  manipulator  parameters 

double  precision  a23,  a34,  a45,  a56,  s22 

c define  constant  manipulator  parameters 
a23  = 9 .OdO 
a34  = 22. OdO 
a45  = 22. OdO 
a56  = 4. OdO 
s22  = 8 . 25d0 

denom2  = (costh (2) * (costh(3)*(costh(4) *costh(5) *sinth(6)-sinth(4)* 

1 sinth(5)*sinth(6) )-sinth(3)*(costh(4)*sinth(5)*sinth(6)+sinth(4 

2 )*costh(5)*sinth(6)))-sinth(2)*costh(6))**2+(-sinth(3)*(costh(4 

3 )*costh(5)*sinth(6)-sinth(4)*sinth(5)*sinth(6))-costh(3)*(costh 

4 (4)*sinth(5)*sinth(6)+sinth(4)*costh(5)*sinth(6) ))**2 

return 

end 
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